| /* |
| * Copyright (c) 2016-2018 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 "wmi_unified_api.h" |
| #include "wmi.h" |
| #include "wmi_version.h" |
| #include "wmi_unified_priv.h" |
| #include "wmi_version_whitelist.h" |
| #include <qdf_module.h> |
| #include <wlan_defs.h> |
| #include <htc_services.h> |
| #ifdef FEATURE_WLAN_APF |
| #include "wmi_unified_apf_tlv.h" |
| #endif |
| #ifdef WLAN_FEATURE_ACTION_OUI |
| #include "wmi_unified_action_oui_tlv.h" |
| #endif |
| #ifdef CONVERGED_P2P_ENABLE |
| #include "wlan_p2p_public_struct.h" |
| #endif |
| #ifdef WLAN_POWER_MANAGEMENT_OFFLOAD |
| #include "wlan_pmo_hw_filter_public_struct.h" |
| #endif |
| #include <wlan_utility.h> |
| #ifdef WLAN_SUPPORT_GREEN_AP |
| #include "wlan_green_ap_api.h" |
| #endif |
| |
| #ifdef WLAN_FEATURE_NAN_CONVERGENCE |
| #include "nan_public_structs.h" |
| #endif |
| #include "wmi_unified_twt_api.h" |
| |
| #ifdef WLAN_POLICY_MGR_ENABLE |
| #include "wlan_policy_mgr_public_struct.h" |
| #endif |
| |
| #ifdef FEATURE_WLAN_TDLS |
| #include "wlan_tdls_public_structs.h" |
| #endif |
| |
| /* HTC service ids for WMI for multi-radio */ |
| static const uint32_t multi_svc_ids[] = {WMI_CONTROL_SVC, |
| WMI_CONTROL_SVC_WMAC1, |
| WMI_CONTROL_SVC_WMAC2}; |
| |
| /** |
| * convert_host_pdev_id_to_target_pdev_id() - Convert pdev_id from |
| * host to target defines. |
| * @param pdev_id: host pdev_id to be converted. |
| * Return: target pdev_id after conversion. |
| */ |
| static uint32_t convert_host_pdev_id_to_target_pdev_id(uint32_t pdev_id) |
| { |
| switch (pdev_id) { |
| case WMI_HOST_PDEV_ID_SOC: |
| return WMI_PDEV_ID_SOC; |
| case WMI_HOST_PDEV_ID_0: |
| return WMI_PDEV_ID_1ST; |
| case WMI_HOST_PDEV_ID_1: |
| return WMI_PDEV_ID_2ND; |
| case WMI_HOST_PDEV_ID_2: |
| return WMI_PDEV_ID_3RD; |
| } |
| |
| QDF_ASSERT(0); |
| |
| return WMI_PDEV_ID_SOC; |
| } |
| |
| /** |
| * convert_target_pdev_id_to_host_pdev_id() - Convert pdev_id from |
| * target to host defines. |
| * @param pdev_id: target pdev_id to be converted. |
| * Return: host pdev_id after conversion. |
| */ |
| static uint32_t convert_target_pdev_id_to_host_pdev_id(uint32_t pdev_id) |
| { |
| switch (pdev_id) { |
| case WMI_PDEV_ID_SOC: |
| return WMI_HOST_PDEV_ID_SOC; |
| case WMI_PDEV_ID_1ST: |
| return WMI_HOST_PDEV_ID_0; |
| case WMI_PDEV_ID_2ND: |
| return WMI_HOST_PDEV_ID_1; |
| case WMI_PDEV_ID_3RD: |
| return WMI_HOST_PDEV_ID_2; |
| } |
| |
| QDF_ASSERT(0); |
| |
| return WMI_HOST_PDEV_ID_SOC; |
| } |
| |
| /** |
| * wmi_tlv_pdev_id_conversion_enable() - Enable pdev_id conversion |
| * |
| * Return None. |
| */ |
| static void wmi_tlv_pdev_id_conversion_enable(wmi_unified_t wmi_handle) |
| { |
| wmi_handle->ops->convert_pdev_id_host_to_target = |
| convert_host_pdev_id_to_target_pdev_id; |
| wmi_handle->ops->convert_pdev_id_target_to_host = |
| convert_target_pdev_id_to_host_pdev_id; |
| } |
| |
| /* copy_vdev_create_pdev_id() - copy pdev from host params to target command |
| * buffer. |
| * @wmi_handle: pointer to wmi_handle |
| * @cmd: pointer target vdev create command buffer |
| * @param: pointer host params for vdev create |
| * |
| * Return: None |
| */ |
| #ifdef CONFIG_MCL |
| static inline void copy_vdev_create_pdev_id( |
| struct wmi_unified *wmi_handle, |
| wmi_vdev_create_cmd_fixed_param * cmd, |
| struct vdev_create_params *param) |
| { |
| cmd->pdev_id = WMI_PDEV_ID_SOC; |
| } |
| #else |
| static inline void copy_vdev_create_pdev_id( |
| struct wmi_unified *wmi_handle, |
| wmi_vdev_create_cmd_fixed_param * cmd, |
| struct vdev_create_params *param) |
| { |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| } |
| #endif |
| |
| void wmi_mtrace(uint32_t message_id, uint16_t vdev_id, uint32_t data) |
| { |
| uint16_t mtrace_message_id; |
| |
| mtrace_message_id = QDF_WMI_MTRACE_CMD_ID(message_id) | |
| (QDF_WMI_MTRACE_GRP_ID(message_id) << |
| QDF_WMI_MTRACE_CMD_NUM_BITS); |
| qdf_mtrace(QDF_MODULE_ID_WMI, QDF_MODULE_ID_TARGET, |
| mtrace_message_id, vdev_id, data); |
| } |
| |
| qdf_export_symbol(wmi_mtrace); |
| |
| /** |
| * send_vdev_create_cmd_tlv() - send VDEV create command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold vdev create parameter |
| * @macaddr: vdev mac address |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_vdev_create_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct vdev_create_params *param) |
| { |
| wmi_vdev_create_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| QDF_STATUS ret; |
| int num_bands = 2; |
| uint8_t *buf_ptr; |
| wmi_vdev_txrx_streams *txrx_streams; |
| |
| len += (num_bands * sizeof(*txrx_streams) + WMI_TLV_HDR_SIZE); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_create_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_create_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_create_cmd_fixed_param)); |
| cmd->vdev_id = param->if_id; |
| cmd->vdev_type = param->type; |
| cmd->vdev_subtype = param->subtype; |
| cmd->flags = param->mbssid_flags; |
| cmd->vdevid_trans = param->vdevid_trans; |
| cmd->num_cfg_txrx_streams = num_bands; |
| copy_vdev_create_pdev_id(wmi_handle, cmd, param); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->vdev_macaddr); |
| WMI_LOGD("%s: ID = %d[pdev:%d] VAP Addr = %02x:%02x:%02x:%02x:%02x:%02x", |
| __func__, param->if_id, cmd->pdev_id, |
| macaddr[0], macaddr[1], macaddr[2], |
| macaddr[3], macaddr[4], macaddr[5]); |
| buf_ptr = (uint8_t *)cmd + sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (num_bands * sizeof(wmi_vdev_txrx_streams))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| WMI_LOGD("%s: type %d, subtype %d, nss_2g %d, nss_5g %d", __func__, |
| param->type, param->subtype, |
| param->nss_2g, param->nss_5g); |
| txrx_streams = (wmi_vdev_txrx_streams *)buf_ptr; |
| txrx_streams->band = WMI_TPC_CHAINMASK_CONFIG_BAND_2G; |
| txrx_streams->supported_tx_streams = param->nss_2g; |
| txrx_streams->supported_rx_streams = param->nss_2g; |
| WMITLV_SET_HDR(&txrx_streams->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_txrx_streams, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_txrx_streams)); |
| |
| txrx_streams++; |
| txrx_streams->band = WMI_TPC_CHAINMASK_CONFIG_BAND_5G; |
| txrx_streams->supported_tx_streams = param->nss_5g; |
| txrx_streams->supported_rx_streams = param->nss_5g; |
| WMITLV_SET_HDR(&txrx_streams->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_txrx_streams, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_txrx_streams)); |
| wmi_mtrace(WMI_VDEV_CREATE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, WMI_VDEV_CREATE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_VDEV_CREATE_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_vdev_delete_cmd_tlv() - send VDEV delete command to fw |
| * @wmi_handle: wmi handle |
| * @if_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_vdev_delete_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t if_id) |
| { |
| wmi_vdev_delete_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGP("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_vdev_delete_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_delete_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_delete_cmd_fixed_param)); |
| cmd->vdev_id = if_id; |
| wmi_mtrace(WMI_VDEV_DELETE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(wmi_vdev_delete_cmd_fixed_param), |
| WMI_VDEV_DELETE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_VDEV_DELETE_CMDID"); |
| wmi_buf_free(buf); |
| } |
| WMI_LOGD("%s:vdev id = %d", __func__, if_id); |
| |
| return ret; |
| } |
| |
| /** |
| * send_vdev_stop_cmd_tlv() - send vdev stop command to fw |
| * @wmi: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or erro code |
| */ |
| static QDF_STATUS send_vdev_stop_cmd_tlv(wmi_unified_t wmi, |
| uint8_t vdev_id) |
| { |
| wmi_vdev_stop_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_stop_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_stop_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_stop_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| wmi_mtrace(WMI_VDEV_STOP_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, WMI_VDEV_STOP_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev stop command", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s:vdev id = %d", __func__, vdev_id); |
| |
| return 0; |
| } |
| |
| /** |
| * send_vdev_down_cmd_tlv() - send vdev down command to fw |
| * @wmi: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_vdev_down_cmd_tlv(wmi_unified_t wmi, uint8_t vdev_id) |
| { |
| wmi_vdev_down_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_down_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_down_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_down_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| wmi_mtrace(WMI_VDEV_DOWN_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, WMI_VDEV_DOWN_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev down", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: vdev_id %d", __func__, vdev_id); |
| |
| return 0; |
| } |
| |
| #ifdef CONFIG_MCL |
| static inline void copy_channel_info( |
| wmi_vdev_start_request_cmd_fixed_param * cmd, |
| wmi_channel *chan, |
| struct vdev_start_params *req) |
| { |
| chan->mhz = req->chan_freq; |
| |
| WMI_SET_CHANNEL_MODE(chan, req->chan_mode); |
| |
| chan->band_center_freq1 = req->band_center_freq1; |
| chan->band_center_freq2 = req->band_center_freq2; |
| |
| if (req->is_half_rate) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_HALF_RATE); |
| else if (req->is_quarter_rate) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_QUARTER_RATE); |
| |
| if (req->is_dfs && req->flag_dfs) { |
| WMI_SET_CHANNEL_FLAG(chan, req->flag_dfs); |
| cmd->disable_hw_ack = req->dis_hw_ack; |
| } |
| |
| WMI_SET_CHANNEL_REG_POWER(chan, req->max_txpow); |
| WMI_SET_CHANNEL_MAX_TX_POWER(chan, req->max_txpow); |
| |
| } |
| #else |
| static inline void copy_channel_info( |
| wmi_vdev_start_request_cmd_fixed_param * cmd, |
| wmi_channel *chan, |
| struct vdev_start_params *req) |
| { |
| chan->mhz = req->channel.mhz; |
| |
| WMI_SET_CHANNEL_MODE(chan, req->channel.phy_mode); |
| |
| chan->band_center_freq1 = req->channel.cfreq1; |
| chan->band_center_freq2 = req->channel.cfreq2; |
| WMI_LOGI("%s: req->channel.phy_mode: %d ", req->channel.phy_mode); |
| |
| if (req->channel.half_rate) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_HALF_RATE); |
| else if (req->channel.quarter_rate) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_QUARTER_RATE); |
| |
| WMI_LOGI("%s: req->channel.dfs_set: %d ", req->channel.dfs_set); |
| |
| if (req->channel.dfs_set) { |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_DFS); |
| cmd->disable_hw_ack = req->disable_hw_ack; |
| } |
| |
| if (req->channel.dfs_set_cfreq2) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_DFS_CFREQ2); |
| |
| /* According to firmware both reg power and max tx power |
| * on set channel power is used and set it to max reg |
| * power from regulatory. |
| */ |
| WMI_SET_CHANNEL_MIN_POWER(chan, req->channel.minpower); |
| WMI_SET_CHANNEL_MAX_POWER(chan, req->channel.maxpower); |
| WMI_SET_CHANNEL_REG_POWER(chan, req->channel.maxregpower); |
| WMI_SET_CHANNEL_ANTENNA_MAX(chan, req->channel.antennamax); |
| WMI_SET_CHANNEL_REG_CLASSID(chan, req->channel.reg_class_id); |
| WMI_SET_CHANNEL_MAX_TX_POWER(chan, req->channel.maxregpower); |
| |
| } |
| #endif |
| /** |
| * send_vdev_start_cmd_tlv() - send vdev start request to fw |
| * @wmi_handle: wmi handle |
| * @req: vdev start params |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_vdev_start_cmd_tlv(wmi_unified_t wmi_handle, |
| struct vdev_start_params *req) |
| { |
| wmi_vdev_start_request_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| wmi_channel *chan; |
| int32_t len, ret; |
| uint8_t *buf_ptr; |
| |
| len = sizeof(*cmd) + sizeof(wmi_channel) + WMI_TLV_HDR_SIZE; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_vdev_start_request_cmd_fixed_param *) buf_ptr; |
| chan = (wmi_channel *) (buf_ptr + sizeof(*cmd)); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_start_request_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_start_request_cmd_fixed_param)); |
| WMITLV_SET_HDR(&chan->tlv_header, WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| cmd->vdev_id = req->vdev_id; |
| |
| /* Fill channel info */ |
| copy_channel_info(cmd, chan, req); |
| |
| cmd->beacon_interval = req->beacon_intval; |
| cmd->dtim_period = req->dtim_period; |
| |
| cmd->bcn_tx_rate = req->bcn_tx_rate_code; |
| if (req->bcn_tx_rate_code) |
| cmd->flags |= WMI_UNIFIED_VDEV_START_BCN_TX_RATE_PRESENT; |
| |
| if (!req->is_restart) { |
| cmd->beacon_interval = req->beacon_intval; |
| cmd->dtim_period = req->dtim_period; |
| |
| /* Copy the SSID */ |
| if (req->ssid.length) { |
| if (req->ssid.length < sizeof(cmd->ssid.ssid)) |
| cmd->ssid.ssid_len = req->ssid.length; |
| else |
| cmd->ssid.ssid_len = sizeof(cmd->ssid.ssid); |
| qdf_mem_copy(cmd->ssid.ssid, req->ssid.mac_ssid, |
| cmd->ssid.ssid_len); |
| } |
| |
| if (req->hidden_ssid) |
| cmd->flags |= WMI_UNIFIED_VDEV_START_HIDDEN_SSID; |
| |
| if (req->pmf_enabled) |
| cmd->flags |= WMI_UNIFIED_VDEV_START_PMF_ENABLED; |
| } |
| |
| cmd->flags |= WMI_UNIFIED_VDEV_START_LDPC_RX_ENABLED; |
| cmd->num_noa_descriptors = req->num_noa_descriptors; |
| cmd->preferred_rx_streams = req->preferred_rx_streams; |
| cmd->preferred_tx_streams = req->preferred_tx_streams; |
| cmd->cac_duration_ms = req->cac_duration_ms; |
| cmd->regdomain = req->regdomain; |
| cmd->he_ops = req->he_ops; |
| |
| buf_ptr = (uint8_t *) (((uintptr_t) cmd) + sizeof(*cmd) + |
| sizeof(wmi_channel)); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| cmd->num_noa_descriptors * |
| sizeof(wmi_p2p_noa_descriptor)); |
| WMI_LOGI("%s: vdev_id %d freq %d chanmode %d ch_info: 0x%x is_dfs %d " |
| "beacon interval %d dtim %d center_chan %d center_freq2 %d " |
| "reg_info_1: 0x%x reg_info_2: 0x%x, req->max_txpow: 0x%x " |
| "Tx SS %d, Rx SS %d, ldpc_rx: %d, cac %d, regd %d, HE ops: %d" |
| "req->dis_hw_ack: %d ", __func__, req->vdev_id, |
| chan->mhz, req->chan_mode, chan->info, |
| req->is_dfs, req->beacon_intval, cmd->dtim_period, |
| chan->band_center_freq1, chan->band_center_freq2, |
| chan->reg_info_1, chan->reg_info_2, req->max_txpow, |
| req->preferred_tx_streams, req->preferred_rx_streams, |
| req->ldpc_rx_enabled, req->cac_duration_ms, |
| req->regdomain, req->he_ops, |
| req->dis_hw_ack); |
| |
| if (req->is_restart) { |
| wmi_mtrace(WMI_VDEV_RESTART_REQUEST_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_RESTART_REQUEST_CMDID); |
| } else { |
| wmi_mtrace(WMI_VDEV_START_REQUEST_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_START_REQUEST_CMDID); |
| } |
| if (ret) { |
| WMI_LOGP("%s: Failed to send vdev start command", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_hidden_ssid_vdev_restart_cmd_tlv() - restart vdev to set hidden ssid |
| * @wmi_handle: wmi handle |
| * @restart_params: vdev restart params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_hidden_ssid_vdev_restart_cmd_tlv(wmi_unified_t wmi_handle, |
| struct hidden_ssid_vdev_restart_params *restart_params) |
| { |
| wmi_vdev_start_request_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| wmi_channel *chan; |
| int32_t len; |
| uint8_t *buf_ptr; |
| QDF_STATUS ret = 0; |
| |
| len = sizeof(*cmd) + sizeof(wmi_channel) + WMI_TLV_HDR_SIZE; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_vdev_start_request_cmd_fixed_param *) buf_ptr; |
| chan = (wmi_channel *) (buf_ptr + sizeof(*cmd)); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_start_request_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_start_request_cmd_fixed_param)); |
| |
| WMITLV_SET_HDR(&chan->tlv_header, |
| WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| |
| cmd->vdev_id = restart_params->session_id; |
| cmd->ssid.ssid_len = restart_params->ssid_len; |
| qdf_mem_copy(cmd->ssid.ssid, |
| restart_params->ssid, |
| cmd->ssid.ssid_len); |
| cmd->flags = restart_params->flags; |
| cmd->requestor_id = restart_params->requestor_id; |
| cmd->disable_hw_ack = restart_params->disable_hw_ack; |
| |
| chan->mhz = restart_params->mhz; |
| chan->band_center_freq1 = |
| restart_params->band_center_freq1; |
| chan->band_center_freq2 = |
| restart_params->band_center_freq2; |
| chan->info = restart_params->info; |
| chan->reg_info_1 = restart_params->reg_info_1; |
| chan->reg_info_2 = restart_params->reg_info_2; |
| |
| cmd->num_noa_descriptors = 0; |
| buf_ptr = (uint8_t *) (((uint8_t *) cmd) + sizeof(*cmd) + |
| sizeof(wmi_channel)); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| cmd->num_noa_descriptors * |
| sizeof(wmi_p2p_noa_descriptor)); |
| |
| wmi_mtrace(WMI_VDEV_RESTART_REQUEST_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_RESTART_REQUEST_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| |
| /** |
| * send_peer_flush_tids_cmd_tlv() - flush peer tids packets in fw |
| * @wmi: wmi handle |
| * @peer_addr: peer mac address |
| * @param: pointer to hold peer flush tid parameter |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS send_peer_flush_tids_cmd_tlv(wmi_unified_t wmi, |
| uint8_t peer_addr[IEEE80211_ADDR_LEN], |
| struct peer_flush_params *param) |
| { |
| wmi_peer_flush_tids_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_peer_flush_tids_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_flush_tids_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_flush_tids_cmd_fixed_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr); |
| cmd->peer_tid_bitmap = param->peer_tid_bitmap; |
| cmd->vdev_id = param->vdev_id; |
| WMI_LOGD("%s: peer_addr %pM vdev_id %d and peer bitmap %d", __func__, |
| peer_addr, param->vdev_id, |
| param->peer_tid_bitmap); |
| wmi_mtrace(WMI_PEER_FLUSH_TIDS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, WMI_PEER_FLUSH_TIDS_CMDID)) { |
| WMI_LOGP("%s: Failed to send flush tid command", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_peer_delete_cmd_tlv() - send PEER delete command to fw |
| * @wmi: wmi handle |
| * @peer_addr: peer mac addr |
| * @vdev_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_peer_delete_cmd_tlv(wmi_unified_t wmi, |
| uint8_t peer_addr[IEEE80211_ADDR_LEN], |
| uint8_t vdev_id) |
| { |
| wmi_peer_delete_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_peer_delete_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_delete_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_delete_cmd_fixed_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr); |
| cmd->vdev_id = vdev_id; |
| |
| WMI_LOGD("%s: peer_addr %pM vdev_id %d", __func__, peer_addr, vdev_id); |
| wmi_mtrace(WMI_PEER_DELETE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, WMI_PEER_DELETE_CMDID)) { |
| WMI_LOGP("%s: Failed to send peer delete command", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * convert_host_peer_id_to_target_id_tlv - convert host peer param_id |
| * to target id. |
| * @targ_paramid: Target parameter id to hold the result. |
| * @peer_param_id: host param id. |
| * |
| * Return: QDF_STATUS_SUCCESS for success |
| * QDF_STATUS_E_NOSUPPORT when the param_id in not supported in tareget |
| */ |
| #ifdef CONFIG_MCL |
| static QDF_STATUS convert_host_peer_id_to_target_id_tlv( |
| uint32_t *targ_paramid, |
| uint32_t peer_param_id) |
| { |
| *targ_paramid = peer_param_id; |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * crash_on_send_peer_rx_reorder_queue_remove_cmd() - crash on reorder queue cmd |
| * |
| * On MCL side, we are suspecting this cmd to trigger drop of ARP |
| * response frames from REO by the FW. This function causes a crash if this |
| * command is sent out by the host, so we can track this issue. Ideally no one |
| * should be calling this API from the MCL side |
| * |
| * Return: None |
| */ |
| static void crash_on_send_peer_rx_reorder_queue_remove_cmd(void) |
| { |
| QDF_BUG(0); |
| } |
| #else |
| static QDF_STATUS convert_host_peer_id_to_target_id_tlv( |
| uint32_t *targ_paramid, |
| uint32_t peer_param_id) |
| { |
| switch (peer_param_id) { |
| case WMI_HOST_PEER_MIMO_PS_STATE: |
| *targ_paramid = WMI_PEER_MIMO_PS_STATE; |
| break; |
| case WMI_HOST_PEER_AMPDU: |
| *targ_paramid = WMI_PEER_AMPDU; |
| break; |
| case WMI_HOST_PEER_AUTHORIZE: |
| *targ_paramid = WMI_PEER_AUTHORIZE; |
| break; |
| case WMI_HOST_PEER_CHWIDTH: |
| *targ_paramid = WMI_PEER_CHWIDTH; |
| break; |
| case WMI_HOST_PEER_NSS: |
| *targ_paramid = WMI_PEER_NSS; |
| break; |
| case WMI_HOST_PEER_USE_4ADDR: |
| *targ_paramid = WMI_PEER_USE_4ADDR; |
| break; |
| case WMI_HOST_PEER_MEMBERSHIP: |
| *targ_paramid = WMI_PEER_MEMBERSHIP; |
| break; |
| case WMI_HOST_PEER_USERPOS: |
| *targ_paramid = WMI_PEER_USERPOS; |
| break; |
| case WMI_HOST_PEER_CRIT_PROTO_HINT_ENABLED: |
| *targ_paramid = WMI_PEER_CRIT_PROTO_HINT_ENABLED; |
| break; |
| case WMI_HOST_PEER_TX_FAIL_CNT_THR: |
| *targ_paramid = WMI_PEER_TX_FAIL_CNT_THR; |
| break; |
| case WMI_HOST_PEER_SET_HW_RETRY_CTS2S: |
| *targ_paramid = WMI_PEER_SET_HW_RETRY_CTS2S; |
| break; |
| case WMI_HOST_PEER_IBSS_ATIM_WINDOW_LENGTH: |
| *targ_paramid = WMI_PEER_IBSS_ATIM_WINDOW_LENGTH; |
| break; |
| case WMI_HOST_PEER_PHYMODE: |
| *targ_paramid = WMI_PEER_PHYMODE; |
| break; |
| case WMI_HOST_PEER_USE_FIXED_PWR: |
| *targ_paramid = WMI_PEER_USE_FIXED_PWR; |
| break; |
| case WMI_HOST_PEER_PARAM_FIXED_RATE: |
| *targ_paramid = WMI_PEER_PARAM_FIXED_RATE; |
| break; |
| case WMI_HOST_PEER_SET_MU_WHITELIST: |
| *targ_paramid = WMI_PEER_SET_MU_WHITELIST; |
| break; |
| case WMI_HOST_PEER_SET_MAC_TX_RATE: |
| *targ_paramid = WMI_PEER_SET_MAX_TX_RATE; |
| break; |
| case WMI_HOST_PEER_SET_MIN_TX_RATE: |
| *targ_paramid = WMI_PEER_SET_MIN_TX_RATE; |
| break; |
| case WMI_HOST_PEER_SET_DEFAULT_ROUTING: |
| *targ_paramid = WMI_PEER_SET_DEFAULT_ROUTING; |
| break; |
| case WMI_HOST_PEER_NSS_VHT160: |
| *targ_paramid = WMI_PEER_NSS_VHT160; |
| break; |
| case WMI_HOST_PEER_NSS_VHT80_80: |
| *targ_paramid = WMI_PEER_NSS_VHT80_80; |
| break; |
| case WMI_HOST_PEER_PARAM_SU_TXBF_SOUNDING_INTERVAL: |
| *targ_paramid = WMI_PEER_PARAM_SU_TXBF_SOUNDING_INTERVAL; |
| break; |
| case WMI_HOST_PEER_PARAM_MU_TXBF_SOUNDING_INTERVAL: |
| *targ_paramid = WMI_PEER_PARAM_MU_TXBF_SOUNDING_INTERVAL; |
| break; |
| case WMI_HOST_PEER_PARAM_TXBF_SOUNDING_ENABLE: |
| *targ_paramid = WMI_PEER_PARAM_TXBF_SOUNDING_ENABLE; |
| break; |
| case WMI_HOST_PEER_PARAM_MU_ENABLE: |
| *targ_paramid = WMI_PEER_PARAM_MU_ENABLE; |
| break; |
| case WMI_HOST_PEER_PARAM_OFDMA_ENABLE: |
| *targ_paramid = WMI_PEER_PARAM_OFDMA_ENABLE; |
| break; |
| default: |
| return QDF_STATUS_E_NOSUPPORT; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static void crash_on_send_peer_rx_reorder_queue_remove_cmd(void) |
| { |
| /* No-OP */ |
| } |
| |
| #endif |
| /** |
| * send_peer_param_cmd_tlv() - set peer parameter in fw |
| * @wmi: wmi handle |
| * @peer_addr: peer mac address |
| * @param : pointer to hold peer set parameter |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_peer_param_cmd_tlv(wmi_unified_t wmi, |
| uint8_t peer_addr[IEEE80211_ADDR_LEN], |
| struct peer_set_params *param) |
| { |
| wmi_peer_set_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t err; |
| uint32_t param_id; |
| |
| if (convert_host_peer_id_to_target_id_tlv(¶m_id, |
| param->param_id) != QDF_STATUS_SUCCESS) |
| return QDF_STATUS_E_NOSUPPORT; |
| |
| buf = wmi_buf_alloc(wmi, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set_param cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_peer_set_param_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_set_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_set_param_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr); |
| cmd->param_id = param_id; |
| cmd->param_value = param->param_value; |
| wmi_mtrace(WMI_PEER_SET_PARAM_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi, buf, |
| sizeof(wmi_peer_set_param_cmd_fixed_param), |
| WMI_PEER_SET_PARAM_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send set_param cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_vdev_up_cmd_tlv() - send vdev up command in fw |
| * @wmi: wmi handle |
| * @bssid: bssid |
| * @vdev_up_params: pointer to hold vdev up parameter |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_vdev_up_cmd_tlv(wmi_unified_t wmi, |
| uint8_t bssid[IEEE80211_ADDR_LEN], |
| struct vdev_up_params *params) |
| { |
| wmi_vdev_up_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| WMI_LOGD("%s: VDEV_UP", __func__); |
| WMI_LOGD("%s: vdev_id %d aid %d bssid %pM", __func__, |
| params->vdev_id, params->assoc_id, bssid); |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_up_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_up_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_up_cmd_fixed_param)); |
| cmd->vdev_id = params->vdev_id; |
| cmd->vdev_assoc_id = params->assoc_id; |
| cmd->profile_idx = params->profile_idx; |
| cmd->profile_num = params->profile_num; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(params->trans_bssid, &cmd->trans_bssid); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid, &cmd->vdev_bssid); |
| wmi_mtrace(WMI_VDEV_UP_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, WMI_VDEV_UP_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev up command", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_peer_create_cmd_tlv() - send peer create command to fw |
| * @wmi: wmi handle |
| * @peer_addr: peer mac address |
| * @peer_type: peer type |
| * @vdev_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_peer_create_cmd_tlv(wmi_unified_t wmi, |
| struct peer_create_params *param) |
| { |
| wmi_peer_create_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_peer_create_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_create_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_create_cmd_fixed_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_addr, &cmd->peer_macaddr); |
| cmd->peer_type = param->peer_type; |
| cmd->vdev_id = param->vdev_id; |
| |
| wmi_mtrace(WMI_PEER_CREATE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, WMI_PEER_CREATE_CMDID)) { |
| WMI_LOGP("%s: failed to send WMI_PEER_CREATE_CMDID", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: peer_addr %pM vdev_id %d", __func__, param->peer_addr, |
| param->vdev_id); |
| |
| return 0; |
| } |
| |
| /** |
| * send_peer_rx_reorder_queue_setup_cmd_tlv() - send rx reorder setup |
| * command to fw |
| * @wmi: wmi handle |
| * @rx_reorder_queue_setup_params: Rx reorder queue setup parameters |
| * |
| * Return: 0 for success or error code |
| */ |
| static |
| QDF_STATUS send_peer_rx_reorder_queue_setup_cmd_tlv(wmi_unified_t wmi, |
| struct rx_reorder_queue_setup_params *param) |
| { |
| wmi_peer_reorder_queue_setup_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_peer_reorder_queue_setup_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_reorder_queue_setup_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_reorder_queue_setup_cmd_fixed_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_macaddr, &cmd->peer_macaddr); |
| cmd->vdev_id = param->vdev_id; |
| cmd->tid = param->tid; |
| cmd->queue_ptr_lo = param->hw_qdesc_paddr_lo; |
| cmd->queue_ptr_hi = param->hw_qdesc_paddr_hi; |
| cmd->queue_no = param->queue_no; |
| cmd->ba_window_size_valid = param->ba_window_size_valid; |
| cmd->ba_window_size = param->ba_window_size; |
| |
| |
| wmi_mtrace(WMI_PEER_REORDER_QUEUE_SETUP_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, |
| WMI_PEER_REORDER_QUEUE_SETUP_CMDID)) { |
| WMI_LOGP("%s: fail to send WMI_PEER_REORDER_QUEUE_SETUP_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: peer_macaddr %pM vdev_id %d, tid %d\n", __func__, |
| param->peer_macaddr, param->vdev_id, param->tid); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_peer_rx_reorder_queue_remove_cmd_tlv() - send rx reorder remove |
| * command to fw |
| * @wmi: wmi handle |
| * @rx_reorder_queue_remove_params: Rx reorder queue remove parameters |
| * |
| * Return: 0 for success or error code |
| */ |
| static |
| QDF_STATUS send_peer_rx_reorder_queue_remove_cmd_tlv(wmi_unified_t wmi, |
| struct rx_reorder_queue_remove_params *param) |
| { |
| wmi_peer_reorder_queue_remove_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| crash_on_send_peer_rx_reorder_queue_remove_cmd(); |
| |
| buf = wmi_buf_alloc(wmi, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_peer_reorder_queue_remove_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_reorder_queue_remove_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_reorder_queue_remove_cmd_fixed_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_macaddr, &cmd->peer_macaddr); |
| cmd->vdev_id = param->vdev_id; |
| cmd->tid_mask = param->peer_tid_bitmap; |
| |
| wmi_mtrace(WMI_PEER_REORDER_QUEUE_REMOVE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi, buf, len, |
| WMI_PEER_REORDER_QUEUE_REMOVE_CMDID)) { |
| WMI_LOGP("%s: fail to send WMI_PEER_REORDER_QUEUE_REMOVE_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: peer_macaddr %pM vdev_id %d, tid_map %d", __func__, |
| param->peer_macaddr, param->vdev_id, param->peer_tid_bitmap); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * 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); |
| return wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_ADD_WDS_ENTRY_CMDID); |
| } |
| |
| /** |
| * 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); |
| return wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_REMOVE_WDS_ENTRY_CMDID); |
| } |
| |
| /** |
| * send_peer_update_wds_entry_cmd_non_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); |
| return wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_UPDATE_WDS_ENTRY_CMDID); |
| } |
| |
| /** |
| * 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\n", __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; |
| } |
| |
| #ifdef WLAN_SUPPORT_GREEN_AP |
| /** |
| * send_green_ap_ps_cmd_tlv() - enable green ap powersave command |
| * @wmi_handle: wmi handle |
| * @value: value |
| * @pdev_id: pdev id to have radio context |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_green_ap_ps_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t value, uint8_t pdev_id) |
| { |
| wmi_pdev_green_ap_ps_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| WMI_LOGD("Set Green AP PS val %d", value); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: Green AP PS Mem Alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_pdev_green_ap_ps_enable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_green_ap_ps_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_green_ap_ps_enable_cmd_fixed_param)); |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(pdev_id); |
| cmd->enable = value; |
| |
| wmi_mtrace(WMI_PDEV_GREEN_AP_PS_ENABLE_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_GREEN_AP_PS_ENABLE_CMDID)) { |
| WMI_LOGE("Set Green AP PS param Failed val %d", value); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| #endif |
| |
| /** |
| * send_pdev_utf_cmd_tlv() - send utf command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to pdev_utf_params |
| * @mac_id: mac id to have radio context |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS |
| send_pdev_utf_cmd_tlv(wmi_unified_t wmi_handle, |
| struct pdev_utf_params *param, |
| uint8_t mac_id) |
| { |
| wmi_buf_t buf; |
| uint8_t *cmd; |
| /* if param->len is 0 no data is sent, return error */ |
| QDF_STATUS ret = QDF_STATUS_E_INVAL; |
| static uint8_t msgref = 1; |
| uint8_t segNumber = 0, segInfo, numSegments; |
| uint16_t chunk_len, total_bytes; |
| uint8_t *bufpos; |
| struct seg_hdr_info segHdrInfo; |
| |
| bufpos = param->utf_payload; |
| total_bytes = param->len; |
| ASSERT(total_bytes / MAX_WMI_UTF_LEN == |
| (uint8_t) (total_bytes / MAX_WMI_UTF_LEN)); |
| numSegments = (uint8_t) (total_bytes / MAX_WMI_UTF_LEN); |
| |
| if (param->len - (numSegments * MAX_WMI_UTF_LEN)) |
| numSegments++; |
| |
| while (param->len) { |
| if (param->len > MAX_WMI_UTF_LEN) |
| chunk_len = MAX_WMI_UTF_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; |
| segHdrInfo.pad = 0; |
| |
| WMI_LOGD("%s:segHdrInfo.len = %d, segHdrInfo.msgref = %d," |
| " segHdrInfo.segmentInfo = %d", |
| __func__, segHdrInfo.len, segHdrInfo.msgref, |
| segHdrInfo.segmentInfo); |
| |
| WMI_LOGD("%s:total_bytes %d segNumber %d totalSegments %d" |
| "chunk len %d", __func__, total_bytes, segNumber, |
| numSegments, chunk_len); |
| |
| segNumber++; |
| |
| WMITLV_SET_HDR(cmd, WMITLV_TAG_ARRAY_BYTE, |
| (chunk_len + sizeof(segHdrInfo))); |
| cmd += WMI_TLV_HDR_SIZE; |
| memcpy(cmd, &segHdrInfo, sizeof(segHdrInfo)); /* 4 bytes */ |
| memcpy(&cmd[sizeof(segHdrInfo)], bufpos, chunk_len); |
| |
| wmi_mtrace(WMI_PDEV_UTF_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, |
| (chunk_len + sizeof(segHdrInfo) + |
| WMI_TLV_HDR_SIZE), |
| WMI_PDEV_UTF_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_PDEV_UTF_CMDID command"); |
| wmi_buf_free(buf); |
| break; |
| } |
| |
| param->len -= chunk_len; |
| bufpos += chunk_len; |
| } |
| |
| msgref++; |
| |
| return ret; |
| } |
| #ifdef CONFIG_MCL |
| static inline uint32_t convert_host_pdev_param_tlv(wmi_unified_t wmi_handle, |
| uint32_t host_param) |
| { |
| return host_param; |
| } |
| #else |
| static inline uint32_t convert_host_pdev_param_tlv(wmi_unified_t wmi_handle, |
| uint32_t host_param) |
| { |
| if (host_param < wmi_pdev_param_max) |
| return wmi_handle->pdev_param[host_param]; |
| |
| return WMI_UNAVAILABLE_PARAM; |
| } |
| #endif |
| /** |
| * send_pdev_param_cmd_tlv() - set pdev parameters |
| * @wmi_handle: wmi handle |
| * @param: pointer to pdev parameter |
| * @mac_id: radio context |
| * |
| * Return: 0 on success, errno on failure |
| */ |
| static QDF_STATUS |
| send_pdev_param_cmd_tlv(wmi_unified_t wmi_handle, |
| struct pdev_params *param, |
| uint8_t mac_id) |
| { |
| QDF_STATUS ret; |
| wmi_pdev_set_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(*cmd); |
| uint32_t pdev_param; |
| |
| pdev_param = convert_host_pdev_param_tlv(wmi_handle, param->param_id); |
| if (pdev_param == WMI_UNAVAILABLE_PARAM) { |
| WMI_LOGW("%s: Unavailable param %d\n", |
| __func__, param->param_id); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| 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_set_param_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_set_param_cmd_fixed_param)); |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(mac_id); |
| cmd->param_id = pdev_param; |
| cmd->param_value = param->param_value; |
| WMI_LOGD("Setting pdev param = %x, value = %u", param->param_id, |
| param->param_value); |
| wmi_mtrace(WMI_PDEV_SET_PARAM_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_PARAM_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send set param command ret = %d", ret); |
| wmi_buf_free(buf); |
| } |
| return ret; |
| } |
| |
| /** |
| * send_suspend_cmd_tlv() - WMI suspend function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold suspend parameter |
| * @mac_id: radio context |
| * |
| * Return 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_suspend_cmd_tlv(wmi_unified_t wmi_handle, |
| struct suspend_params *param, |
| uint8_t mac_id) |
| { |
| wmi_pdev_suspend_cmd_fixed_param *cmd; |
| wmi_buf_t wmibuf; |
| uint32_t len = sizeof(*cmd); |
| int32_t ret; |
| |
| /* |
| * send the command to Target to ignore the |
| * PCIE reset so as to ensure that Host and target |
| * states are in sync |
| */ |
| wmibuf = wmi_buf_alloc(wmi_handle, len); |
| if (wmibuf == NULL) |
| return QDF_STATUS_E_NOMEM; |
| |
| cmd = (wmi_pdev_suspend_cmd_fixed_param *) wmi_buf_data(wmibuf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_suspend_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_suspend_cmd_fixed_param)); |
| if (param->disable_target_intr) |
| cmd->suspend_opt = WMI_PDEV_SUSPEND_AND_DISABLE_INTR; |
| else |
| cmd->suspend_opt = WMI_PDEV_SUSPEND; |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(mac_id); |
| |
| wmi_mtrace(WMI_PDEV_SUSPEND_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, wmibuf, len, |
| WMI_PDEV_SUSPEND_CMDID); |
| if (ret) { |
| wmi_buf_free(wmibuf); |
| WMI_LOGE("Failed to send WMI_PDEV_SUSPEND_CMDID command"); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_resume_cmd_tlv() - WMI resume function |
| * @param wmi_handle : handle to WMI. |
| * @mac_id: radio context |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_resume_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t mac_id) |
| { |
| wmi_buf_t wmibuf; |
| wmi_pdev_resume_cmd_fixed_param *cmd; |
| QDF_STATUS ret; |
| |
| wmibuf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (wmibuf == NULL) |
| return QDF_STATUS_E_NOMEM; |
| cmd = (wmi_pdev_resume_cmd_fixed_param *) wmi_buf_data(wmibuf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_resume_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_resume_cmd_fixed_param)); |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(mac_id); |
| wmi_mtrace(WMI_PDEV_RESUME_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, wmibuf, sizeof(*cmd), |
| WMI_PDEV_RESUME_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_PDEV_RESUME_CMDID command"); |
| wmi_buf_free(wmibuf); |
| } |
| |
| return ret; |
| } |
| |
| #ifdef FEATURE_WLAN_D0WOW |
| /** |
| * send_d0wow_enable_cmd_tlv() - WMI d0 wow enable function |
| * @param wmi_handle: handle to WMI. |
| * @mac_id: radio context |
| * |
| * Return: 0 on success and error code on failure. |
| */ |
| static QDF_STATUS send_d0wow_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t mac_id) |
| { |
| wmi_d0_wow_enable_disable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| QDF_STATUS status; |
| |
| len = sizeof(wmi_d0_wow_enable_disable_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_d0_wow_enable_disable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_d0_wow_enable_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_d0_wow_enable_disable_cmd_fixed_param)); |
| |
| cmd->enable = true; |
| |
| wmi_mtrace(WMI_D0_WOW_ENABLE_DISABLE_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_D0_WOW_ENABLE_DISABLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_d0wow_disable_cmd_tlv() - WMI d0 wow disable function |
| * @param wmi_handle: handle to WMI. |
| * @mac_id: radio context |
| * |
| * Return: 0 on success and error code on failure. |
| */ |
| static QDF_STATUS send_d0wow_disable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t mac_id) |
| { |
| wmi_d0_wow_enable_disable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| QDF_STATUS status; |
| |
| len = sizeof(wmi_d0_wow_enable_disable_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_d0_wow_enable_disable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_d0_wow_enable_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_d0_wow_enable_disable_cmd_fixed_param)); |
| |
| cmd->enable = false; |
| |
| wmi_mtrace(WMI_D0_WOW_ENABLE_DISABLE_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_D0_WOW_ENABLE_DISABLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| #endif |
| |
| /** |
| * send_wow_enable_cmd_tlv() - WMI wow enable function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold wow enable parameter |
| * @mac_id: radio context |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_wow_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wow_cmd_params *param, |
| uint8_t mac_id) |
| { |
| wmi_wow_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| int32_t ret; |
| |
| len = sizeof(wmi_wow_enable_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_wow_enable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wow_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wow_enable_cmd_fixed_param)); |
| cmd->enable = param->enable; |
| if (param->can_suspend_link) |
| cmd->pause_iface_config = WOW_IFACE_PAUSE_ENABLED; |
| else |
| cmd->pause_iface_config = WOW_IFACE_PAUSE_DISABLED; |
| cmd->flags = param->flags; |
| |
| WMI_LOGI("suspend type: %s", |
| cmd->pause_iface_config == WOW_IFACE_PAUSE_ENABLED ? |
| "WOW_IFACE_PAUSE_ENABLED" : "WOW_IFACE_PAUSE_DISABLED"); |
| |
| wmi_mtrace(WMI_WOW_ENABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_ENABLE_CMDID); |
| if (ret) |
| wmi_buf_free(buf); |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_ap_ps_param_cmd_tlv() - set ap powersave parameters |
| * @wmi_handle: wmi handle |
| * @peer_addr: peer mac address |
| * @param: pointer to ap_ps parameter structure |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_set_ap_ps_param_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t *peer_addr, |
| struct ap_ps_params *param) |
| { |
| wmi_ap_ps_peer_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t err; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set_ap_ps_param cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_ap_ps_peer_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ap_ps_peer_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_ap_ps_peer_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr); |
| cmd->param = param->param; |
| cmd->value = param->value; |
| wmi_mtrace(WMI_AP_PS_PEER_PARAM_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), WMI_AP_PS_PEER_PARAM_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send set_ap_ps_param cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_set_sta_ps_param_cmd_tlv() - set sta powersave parameters |
| * @wmi_handle: wmi handle |
| * @peer_addr: peer mac address |
| * @param: pointer to sta_ps parameter structure |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_set_sta_ps_param_cmd_tlv(wmi_unified_t wmi_handle, |
| struct sta_ps_params *param) |
| { |
| wmi_sta_powersave_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: Set Sta Ps param Mem Alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_sta_powersave_param_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sta_powersave_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sta_powersave_param_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->param = param->param; |
| cmd->value = param->value; |
| |
| wmi_mtrace(WMI_STA_POWERSAVE_PARAM_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_STA_POWERSAVE_PARAM_CMDID)) { |
| WMI_LOGE("Set Sta Ps param Failed vdevId %d Param %d val %d", |
| param->vdev_id, param->param, param->value); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_crash_inject_cmd_tlv() - inject fw crash |
| * @wmi_handle: wmi handle |
| * @param: ponirt to crash inject parameter structure |
| * |
| * Return: QDF_STATUS_SUCCESS for success or return error |
| */ |
| static QDF_STATUS send_crash_inject_cmd_tlv(wmi_unified_t wmi_handle, |
| struct crash_inject *param) |
| { |
| int32_t ret = 0; |
| WMI_FORCE_FW_HANG_CMD_fixed_param *cmd; |
| uint16_t len = sizeof(*cmd); |
| wmi_buf_t buf; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed!", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_FORCE_FW_HANG_CMD_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_FORCE_FW_HANG_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_FORCE_FW_HANG_CMD_fixed_param)); |
| cmd->type = param->type; |
| cmd->delay_time_ms = param->delay_time_ms; |
| |
| wmi_mtrace(WMI_FORCE_FW_HANG_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_FORCE_FW_HANG_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send set param command, ret = %d", |
| __func__, ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| #ifdef FEATURE_FW_LOG_PARSING |
| /** |
| * send_dbglog_cmd_tlv() - set debug log level |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold dbglog level parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS |
| send_dbglog_cmd_tlv(wmi_unified_t wmi_handle, |
| struct dbglog_params *dbglog_param) |
| { |
| wmi_buf_t buf; |
| wmi_debug_log_config_cmd_fixed_param *configmsg; |
| QDF_STATUS status; |
| int32_t i; |
| int32_t len; |
| int8_t *buf_ptr; |
| int32_t *module_id_bitmap_array; /* Used to fomr the second tlv */ |
| |
| ASSERT(dbglog_param->bitmap_len < MAX_MODULE_ID_BITMAP_WORDS); |
| |
| /* Allocate size for 2 tlvs - including tlv hdr space for second tlv */ |
| len = sizeof(wmi_debug_log_config_cmd_fixed_param) + WMI_TLV_HDR_SIZE + |
| (sizeof(int32_t) * MAX_MODULE_ID_BITMAP_WORDS); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (buf == NULL) |
| return QDF_STATUS_E_NOMEM; |
| |
| configmsg = |
| (wmi_debug_log_config_cmd_fixed_param *) (wmi_buf_data(buf)); |
| buf_ptr = (int8_t *) configmsg; |
| WMITLV_SET_HDR(&configmsg->tlv_header, |
| WMITLV_TAG_STRUC_wmi_debug_log_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_debug_log_config_cmd_fixed_param)); |
| configmsg->dbg_log_param = dbglog_param->param; |
| configmsg->value = dbglog_param->val; |
| /* Filling in the data part of second tlv -- should |
| * follow first tlv _ WMI_TLV_HDR_SIZE */ |
| module_id_bitmap_array = (uint32_t *) (buf_ptr + |
| sizeof |
| (wmi_debug_log_config_cmd_fixed_param) |
| + WMI_TLV_HDR_SIZE); |
| WMITLV_SET_HDR(buf_ptr + sizeof(wmi_debug_log_config_cmd_fixed_param), |
| WMITLV_TAG_ARRAY_UINT32, |
| sizeof(uint32_t) * MAX_MODULE_ID_BITMAP_WORDS); |
| if (dbglog_param->module_id_bitmap) { |
| for (i = 0; i < dbglog_param->bitmap_len; ++i) { |
| module_id_bitmap_array[i] = |
| dbglog_param->module_id_bitmap[i]; |
| } |
| } |
| |
| wmi_mtrace(WMI_DBGLOG_CFG_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_DBGLOG_CFG_CMDID); |
| |
| if (status != QDF_STATUS_SUCCESS) |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| #endif |
| |
| #ifdef CONFIG_MCL |
| static inline uint32_t convert_host_vdev_param_tlv(wmi_unified_t wmi_handle, |
| uint32_t host_param) |
| { |
| return host_param; |
| } |
| #else |
| static inline uint32_t convert_host_vdev_param_tlv(wmi_unified_t wmi_handle, |
| uint32_t host_param) |
| { |
| if (host_param < wmi_vdev_param_max) |
| return wmi_handle->vdev_param[host_param]; |
| |
| return WMI_UNAVAILABLE_PARAM; |
| } |
| #endif |
| /** |
| * send_vdev_set_param_cmd_tlv() - WMI vdev set parameter function |
| * @param wmi_handle : handle to WMI. |
| * @param macaddr : MAC address |
| * @param param : pointer to hold vdev set parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_vdev_set_param_cmd_tlv(wmi_unified_t wmi_handle, |
| struct vdev_set_params *param) |
| { |
| QDF_STATUS ret; |
| wmi_vdev_set_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(*cmd); |
| uint32_t vdev_param; |
| |
| vdev_param = convert_host_vdev_param_tlv(wmi_handle, param->param_id); |
| if (vdev_param == WMI_UNAVAILABLE_PARAM) { |
| WMI_LOGW("%s:Vdev param %d not available", __func__, |
| param->param_id); |
| return QDF_STATUS_E_INVAL; |
| |
| } |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_set_param_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_set_param_cmd_fixed_param)); |
| cmd->vdev_id = param->if_id; |
| cmd->param_id = vdev_param; |
| cmd->param_value = param->param_value; |
| WMI_LOGD("Setting vdev %d param = %x, value = %u", |
| cmd->vdev_id, cmd->param_id, cmd->param_value); |
| wmi_mtrace(WMI_VDEV_SET_PARAM_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SET_PARAM_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send set param command ret = %d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_stats_request_cmd_tlv() - WMI request stats function |
| * @param wmi_handle : handle to WMI. |
| * @param macaddr : MAC address |
| * @param param : pointer to hold stats request parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_stats_request_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct stats_request_params *param) |
| { |
| int32_t ret; |
| wmi_request_stats_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(wmi_request_stats_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_request_stats_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_stats_cmd_fixed_param)); |
| cmd->stats_id = param->stats_id; |
| cmd->vdev_id = param->vdev_id; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| |
| WMI_LOGD("STATS REQ STATS_ID:%d VDEV_ID:%d PDEV_ID:%d-->", |
| cmd->stats_id, cmd->vdev_id, cmd->pdev_id); |
| |
| wmi_mtrace(WMI_REQUEST_STATS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_STATS_CMDID); |
| |
| if (ret) { |
| WMI_LOGE("Failed to send status request to fw =%d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| #ifdef CONFIG_WIN |
| /** |
| * send_packet_log_enable_cmd_tlv() - Send WMI command to enable packet-log |
| * @param wmi_handle : handle to WMI. |
| * @param PKTLOG_EVENT : packet log event |
| * @mac_id: mac id to have radio context |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_packet_log_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| WMI_HOST_PKTLOG_EVENT PKTLOG_EVENT, uint8_t mac_id) |
| { |
| int32_t ret; |
| wmi_pdev_pktlog_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(wmi_pdev_pktlog_enable_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_pktlog_enable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_pktlog_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_pktlog_enable_cmd_fixed_param)); |
| cmd->evlist = PKTLOG_EVENT; |
| cmd->pdev_id = mac_id; |
| wmi_mtrace(WMI_PDEV_PKTLOG_ENABLE_CMDID, cmd->pdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_PKTLOG_ENABLE_CMDID); |
| if (ret) { |
| WMI_LOGE("Failed to send pktlog enable cmd to FW =%d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_packet_log_disable_cmd_tlv() - Send WMI command to disable packet-log |
| * @param wmi_handle : handle to WMI. |
| * @mac_id: mac id to have radio context |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_packet_log_disable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t mac_id) |
| { |
| int32_t ret; |
| wmi_pdev_pktlog_disable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(wmi_pdev_pktlog_disable_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_pktlog_disable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_pktlog_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_pktlog_disable_cmd_fixed_param)); |
| cmd->pdev_id = mac_id; |
| wmi_mtrace(WMI_PDEV_PKTLOG_DISABLE_CMDID, cmd->pdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_PKTLOG_DISABLE_CMDID); |
| if (ret) { |
| WMI_LOGE("Failed to send pktlog disable cmd to FW =%d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| #else |
| /** |
| * send_packet_log_enable_cmd_tlv() - Send WMI command to enable |
| * packet-log |
| * @param wmi_handle : handle to WMI. |
| * @param macaddr : MAC address |
| * @param param : pointer to hold stats request parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_packet_log_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct packet_enable_params *param) |
| { |
| return 0; |
| } |
| /** |
| * send_packet_log_disable_cmd_tlv() - Send WMI command to disable |
| * packet-log |
| * @param wmi_handle : handle to WMI. |
| * @mac_id: mac id to have radio context |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_packet_log_disable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t mac_id) |
| { |
| return 0; |
| } |
| #endif |
| |
| #define WMI_FW_TIME_STAMP_LOW_MASK 0xffffffff |
| /** |
| * send_time_stamp_sync_cmd_tlv() - Send WMI command to |
| * sync time between bwtween host and firmware |
| * @param wmi_handle : handle to WMI. |
| * |
| * Return: None |
| */ |
| static void send_time_stamp_sync_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_buf_t buf; |
| QDF_STATUS status = QDF_STATUS_SUCCESS; |
| WMI_DBGLOG_TIME_STAMP_SYNC_CMD_fixed_param *time_stamp; |
| int32_t len; |
| qdf_time_t time_ms; |
| |
| len = sizeof(*time_stamp); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGP(FL("wmi_buf_alloc failed")); |
| return; |
| } |
| time_stamp = |
| (WMI_DBGLOG_TIME_STAMP_SYNC_CMD_fixed_param *) |
| (wmi_buf_data(buf)); |
| WMITLV_SET_HDR(&time_stamp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dbglog_time_stamp_sync_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| WMI_DBGLOG_TIME_STAMP_SYNC_CMD_fixed_param)); |
| |
| time_ms = qdf_get_time_of_the_day_ms(); |
| time_stamp->mode = WMI_TIME_STAMP_SYNC_MODE_MS; |
| time_stamp->time_stamp_low = time_ms & |
| WMI_FW_TIME_STAMP_LOW_MASK; |
| /* |
| * Send time_stamp_high 0 as the time converted from HR:MIN:SEC:MS to ms |
| * wont exceed 27 bit |
| */ |
| time_stamp->time_stamp_high = 0; |
| WMI_LOGD(FL("WMA --> DBGLOG_TIME_STAMP_SYNC_CMDID mode %d time_stamp low %d high %d"), |
| time_stamp->mode, time_stamp->time_stamp_low, |
| time_stamp->time_stamp_high); |
| |
| wmi_mtrace(WMI_DBGLOG_TIME_STAMP_SYNC_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_DBGLOG_TIME_STAMP_SYNC_CMDID); |
| if (status) { |
| WMI_LOGE("Failed to send WMI_DBGLOG_TIME_STAMP_SYNC_CMDID command"); |
| wmi_buf_free(buf); |
| } |
| |
| } |
| |
| #ifdef WLAN_SUPPORT_FILS |
| /** |
| * 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_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\n", __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; |
| WMI_LOGI("Setting FD period to %d vdev id : %d\n", |
| 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; |
| } |
| |
| /** |
| * 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\n", __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 */ |
| |
| static QDF_STATUS send_beacon_send_cmd_tlv(wmi_unified_t wmi_handle, |
| struct beacon_params *param) |
| { |
| QDF_STATUS ret; |
| wmi_bcn_send_from_host_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| qdf_dma_addr_t dma_addr; |
| uint32_t dtim_flag = 0; |
| |
| 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; |
| } |
| if (param->is_dtim_count_zero) { |
| dtim_flag |= WMI_BCN_SEND_DTIM_ZERO; |
| if (param->is_bitctl_reqd) { |
| /* deliver CAB traffic in next DTIM beacon */ |
| dtim_flag |= WMI_BCN_SEND_DTIM_BITCTL_SET; |
| } |
| } |
| cmd = (wmi_bcn_send_from_host_cmd_fixed_param *) wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bcn_send_from_host_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_bcn_send_from_host_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->data_len = qdf_nbuf_len(param->wbuf); |
| cmd->frame_ctrl = param->frame_ctrl; |
| cmd->dtim_flag = dtim_flag; |
| dma_addr = qdf_nbuf_get_frag_paddr(param->wbuf, 0); |
| cmd->frag_ptr_lo = qdf_get_lower_32_bits(dma_addr); |
| #if defined(HTT_PADDR64) |
| cmd->frag_ptr_hi = qdf_get_upper_32_bits(dma_addr) & 0x1F; |
| #endif |
| cmd->bcn_antenna = param->bcn_txant; |
| |
| wmi_mtrace(WMI_PDEV_SEND_BCN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| wmi_buf, sizeof(*cmd), WMI_PDEV_SEND_BCN_CMDID); |
| if (ret != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: Failed to send bcn: %d", __func__, ret); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_beacon_send_tmpl_cmd_tlv() - WMI beacon send function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold beacon send cmd parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_beacon_tmpl_send_cmd_tlv(wmi_unified_t wmi_handle, |
| struct beacon_tmpl_params *param) |
| { |
| int32_t ret; |
| wmi_bcn_tmpl_cmd_fixed_param *cmd; |
| wmi_bcn_prb_info *bcn_prb_info; |
| wmi_buf_t wmi_buf; |
| uint8_t *buf_ptr; |
| uint32_t wmi_buf_len; |
| |
| wmi_buf_len = sizeof(wmi_bcn_tmpl_cmd_fixed_param) + |
| sizeof(wmi_bcn_prb_info) + WMI_TLV_HDR_SIZE + |
| param->tmpl_len_aligned; |
| wmi_buf = wmi_buf_alloc(wmi_handle, wmi_buf_len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| cmd = (wmi_bcn_tmpl_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bcn_tmpl_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_bcn_tmpl_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->tim_ie_offset = param->tim_ie_offset; |
| cmd->mbssid_ie_offset = param->mbssid_ie_offset; |
| cmd->csa_switch_count_offset = param->csa_switch_count_offset; |
| cmd->ext_csa_switch_count_offset = param->ext_csa_switch_count_offset; |
| cmd->esp_ie_offset = param->esp_ie_offset; |
| cmd->buf_len = param->tmpl_len; |
| buf_ptr += sizeof(wmi_bcn_tmpl_cmd_fixed_param); |
| |
| bcn_prb_info = (wmi_bcn_prb_info *) buf_ptr; |
| WMITLV_SET_HDR(&bcn_prb_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bcn_prb_info, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_bcn_prb_info)); |
| bcn_prb_info->caps = 0; |
| bcn_prb_info->erp = 0; |
| buf_ptr += sizeof(wmi_bcn_prb_info); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, param->tmpl_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, param->frm, param->tmpl_len); |
| |
| wmi_mtrace(WMI_BCN_TMPL_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| wmi_buf, wmi_buf_len, WMI_BCN_TMPL_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send bcn tmpl: %d", __func__, ret); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| return 0; |
| } |
| |
| #ifdef CONFIG_MCL |
| static inline void copy_peer_flags_tlv( |
| wmi_peer_assoc_complete_cmd_fixed_param * cmd, |
| struct peer_assoc_params *param) |
| { |
| cmd->peer_flags = param->peer_flags; |
| } |
| #else |
| static inline void copy_peer_flags_tlv( |
| wmi_peer_assoc_complete_cmd_fixed_param * cmd, |
| struct peer_assoc_params *param) |
| { |
| /* |
| * The target only needs a subset of the flags maintained in the host. |
| * Just populate those flags and send it down |
| */ |
| cmd->peer_flags = 0; |
| |
| /* |
| * Do not enable HT/VHT if WMM/wme is disabled for vap. |
| */ |
| if (param->is_wme_set) { |
| |
| if (param->qos_flag) |
| cmd->peer_flags |= WMI_PEER_QOS; |
| if (param->apsd_flag) |
| cmd->peer_flags |= WMI_PEER_APSD; |
| if (param->ht_flag) |
| cmd->peer_flags |= WMI_PEER_HT; |
| if (param->bw_40) |
| cmd->peer_flags |= WMI_PEER_40MHZ; |
| if (param->bw_80) |
| cmd->peer_flags |= WMI_PEER_80MHZ; |
| if (param->bw_160) |
| cmd->peer_flags |= WMI_PEER_160MHZ; |
| |
| /* Typically if STBC is enabled for VHT it should be enabled |
| * for HT as well |
| **/ |
| if (param->stbc_flag) |
| cmd->peer_flags |= WMI_PEER_STBC; |
| |
| /* Typically if LDPC is enabled for VHT it should be enabled |
| * for HT as well |
| **/ |
| if (param->ldpc_flag) |
| cmd->peer_flags |= WMI_PEER_LDPC; |
| |
| if (param->static_mimops_flag) |
| cmd->peer_flags |= WMI_PEER_STATIC_MIMOPS; |
| if (param->dynamic_mimops_flag) |
| cmd->peer_flags |= WMI_PEER_DYN_MIMOPS; |
| if (param->spatial_mux_flag) |
| cmd->peer_flags |= WMI_PEER_SPATIAL_MUX; |
| if (param->vht_flag) |
| cmd->peer_flags |= WMI_PEER_VHT; |
| if (param->he_flag) |
| cmd->peer_flags |= WMI_PEER_HE; |
| } |
| |
| if (param->is_pmf_enabled) |
| cmd->peer_flags |= WMI_PEER_PMF; |
| /* |
| * Suppress authorization for all AUTH modes that need 4-way handshake |
| * (during re-association). |
| * Authorization will be done for these modes on key installation. |
| */ |
| if (param->auth_flag) |
| cmd->peer_flags |= WMI_PEER_AUTH; |
| if (param->need_ptk_4_way) |
| cmd->peer_flags |= WMI_PEER_NEED_PTK_4_WAY; |
| else |
| cmd->peer_flags &= ~WMI_PEER_NEED_PTK_4_WAY; |
| if (param->need_gtk_2_way) |
| cmd->peer_flags |= WMI_PEER_NEED_GTK_2_WAY; |
| /* safe mode bypass the 4-way handshake */ |
| if (param->safe_mode_enabled) |
| cmd->peer_flags &= |
| ~(WMI_PEER_NEED_PTK_4_WAY | WMI_PEER_NEED_GTK_2_WAY); |
| /* Disable AMSDU for station transmit, if user configures it */ |
| /* Disable AMSDU for AP transmit to 11n Stations, if user configures |
| * it |
| * if (param->amsdu_disable) Add after FW support |
| **/ |
| |
| /* Target asserts if node is marked HT and all MCS is set to 0. |
| * Mark the node as non-HT if all the mcs rates are disabled through |
| * iwpriv |
| **/ |
| if (param->peer_ht_rates.num_rates == 0) |
| cmd->peer_flags &= ~WMI_PEER_HT; |
| |
| if (param->twt_requester) |
| cmd->peer_flags |= WMI_PEER_TWT_REQ; |
| |
| if (param->twt_responder) |
| cmd->peer_flags |= WMI_PEER_TWT_RESP; |
| } |
| #endif |
| |
| #ifdef CONFIG_MCL |
| static inline void copy_peer_mac_addr_tlv( |
| wmi_peer_assoc_complete_cmd_fixed_param * cmd, |
| struct peer_assoc_params *param) |
| { |
| qdf_mem_copy(&cmd->peer_macaddr, ¶m->peer_macaddr, |
| sizeof(param->peer_macaddr)); |
| } |
| #else |
| static inline void copy_peer_mac_addr_tlv( |
| wmi_peer_assoc_complete_cmd_fixed_param * cmd, |
| struct peer_assoc_params *param) |
| { |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_mac, &cmd->peer_macaddr); |
| } |
| #endif |
| |
| /** |
| * send_peer_assoc_cmd_tlv() - WMI peer assoc function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to peer assoc parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_peer_assoc_cmd_tlv(wmi_unified_t wmi_handle, |
| struct peer_assoc_params *param) |
| { |
| wmi_peer_assoc_complete_cmd_fixed_param *cmd; |
| wmi_vht_rate_set *mcs; |
| wmi_he_rate_set *he_mcs; |
| wmi_buf_t buf; |
| int32_t len; |
| uint8_t *buf_ptr; |
| QDF_STATUS ret; |
| uint32_t peer_legacy_rates_align; |
| uint32_t peer_ht_rates_align; |
| int32_t i; |
| |
| |
| peer_legacy_rates_align = wmi_align(param->peer_legacy_rates.num_rates); |
| peer_ht_rates_align = wmi_align(param->peer_ht_rates.num_rates); |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + |
| (peer_legacy_rates_align * sizeof(uint8_t)) + |
| WMI_TLV_HDR_SIZE + |
| (peer_ht_rates_align * sizeof(uint8_t)) + |
| sizeof(wmi_vht_rate_set) + |
| (sizeof(wmi_he_rate_set) * param->peer_he_mcs_count |
| + WMI_TLV_HDR_SIZE); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_peer_assoc_complete_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_assoc_complete_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_assoc_complete_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| |
| cmd->peer_new_assoc = param->peer_new_assoc; |
| cmd->peer_associd = param->peer_associd; |
| |
| copy_peer_flags_tlv(cmd, param); |
| copy_peer_mac_addr_tlv(cmd, param); |
| |
| cmd->peer_rate_caps = param->peer_rate_caps; |
| cmd->peer_caps = param->peer_caps; |
| cmd->peer_listen_intval = param->peer_listen_intval; |
| cmd->peer_ht_caps = param->peer_ht_caps; |
| cmd->peer_max_mpdu = param->peer_max_mpdu; |
| cmd->peer_mpdu_density = param->peer_mpdu_density; |
| cmd->peer_vht_caps = param->peer_vht_caps; |
| cmd->peer_phymode = param->peer_phymode; |
| |
| /* Update 11ax capabilities */ |
| cmd->peer_he_cap_info = |
| param->peer_he_cap_macinfo[WMI_HOST_HECAP_MAC_WORD1]; |
| cmd->peer_he_cap_info_ext = |
| param->peer_he_cap_macinfo[WMI_HOST_HECAP_MAC_WORD2]; |
| cmd->peer_he_ops = param->peer_he_ops; |
| qdf_mem_copy(&cmd->peer_he_cap_phy, ¶m->peer_he_cap_phyinfo, |
| sizeof(param->peer_he_cap_phyinfo)); |
| qdf_mem_copy(&cmd->peer_ppet, ¶m->peer_ppet, |
| sizeof(param->peer_ppet)); |
| |
| /* Update peer legacy rate information */ |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| peer_legacy_rates_align); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| cmd->num_peer_legacy_rates = param->peer_legacy_rates.num_rates; |
| qdf_mem_copy(buf_ptr, param->peer_legacy_rates.rates, |
| param->peer_legacy_rates.num_rates); |
| |
| /* Update peer HT rate information */ |
| buf_ptr += peer_legacy_rates_align; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| peer_ht_rates_align); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| cmd->num_peer_ht_rates = param->peer_ht_rates.num_rates; |
| qdf_mem_copy(buf_ptr, param->peer_ht_rates.rates, |
| param->peer_ht_rates.num_rates); |
| |
| /* VHT Rates */ |
| buf_ptr += peer_ht_rates_align; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_STRUC_wmi_vht_rate_set, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vht_rate_set)); |
| |
| cmd->peer_nss = param->peer_nss; |
| |
| /* Update bandwidth-NSS mapping */ |
| cmd->peer_bw_rxnss_override = 0; |
| cmd->peer_bw_rxnss_override |= param->peer_bw_rxnss_override; |
| |
| mcs = (wmi_vht_rate_set *) buf_ptr; |
| if (param->vht_capable) { |
| mcs->rx_max_rate = param->rx_max_rate; |
| mcs->rx_mcs_set = param->rx_mcs_set; |
| mcs->tx_max_rate = param->tx_max_rate; |
| mcs->tx_mcs_set = param->tx_mcs_set; |
| } |
| |
| /* HE Rates */ |
| cmd->peer_he_mcs = param->peer_he_mcs_count; |
| buf_ptr += sizeof(wmi_vht_rate_set); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (param->peer_he_mcs_count * sizeof(wmi_he_rate_set))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Loop through the HE rate set */ |
| for (i = 0; i < param->peer_he_mcs_count; i++) { |
| he_mcs = (wmi_he_rate_set *) buf_ptr; |
| WMITLV_SET_HDR(he_mcs, WMITLV_TAG_STRUC_wmi_he_rate_set, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_he_rate_set)); |
| |
| he_mcs->rx_mcs_set = param->peer_he_rx_mcs_set[i]; |
| he_mcs->tx_mcs_set = param->peer_he_tx_mcs_set[i]; |
| WMI_LOGD("%s:HE idx %d RxMCSmap %x TxMCSmap %x ", __func__, |
| i, he_mcs->rx_mcs_set, he_mcs->tx_mcs_set); |
| buf_ptr += sizeof(wmi_he_rate_set); |
| } |
| |
| |
| WMI_LOGD("%s: vdev_id %d associd %d peer_flags %x rate_caps %x " |
| "peer_caps %x listen_intval %d ht_caps %x max_mpdu %d " |
| "nss %d phymode %d peer_mpdu_density %d " |
| "cmd->peer_vht_caps %x " |
| "HE cap_info %x ops %x " |
| "HE cap_info_ext %x " |
| "HE phy %x %x %x " |
| "peer_bw_rxnss_override %x", __func__, |
| cmd->vdev_id, cmd->peer_associd, cmd->peer_flags, |
| cmd->peer_rate_caps, cmd->peer_caps, |
| cmd->peer_listen_intval, cmd->peer_ht_caps, |
| cmd->peer_max_mpdu, cmd->peer_nss, cmd->peer_phymode, |
| cmd->peer_mpdu_density, |
| cmd->peer_vht_caps, cmd->peer_he_cap_info, |
| cmd->peer_he_ops, cmd->peer_he_cap_info_ext, |
| cmd->peer_he_cap_phy[0], cmd->peer_he_cap_phy[1], |
| cmd->peer_he_cap_phy[2], |
| cmd->peer_bw_rxnss_override); |
| |
| wmi_mtrace(WMI_PEER_ASSOC_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_ASSOC_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGP("%s: Failed to send peer assoc command ret = %d", |
| __func__, ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /* copy_scan_notify_events() - Helper routine to copy scan notify events |
| */ |
| static inline void copy_scan_event_cntrl_flags( |
| wmi_start_scan_cmd_fixed_param * cmd, |
| struct scan_req_params *param) |
| { |
| |
| /* Scan events subscription */ |
| if (param->scan_ev_started) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_STARTED; |
| if (param->scan_ev_completed) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_COMPLETED; |
| if (param->scan_ev_bss_chan) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_BSS_CHANNEL; |
| if (param->scan_ev_foreign_chan) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_FOREIGN_CHANNEL; |
| if (param->scan_ev_dequeued) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_DEQUEUED; |
| if (param->scan_ev_preempted) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_PREEMPTED; |
| if (param->scan_ev_start_failed) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_START_FAILED; |
| if (param->scan_ev_restarted) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_RESTARTED; |
| if (param->scan_ev_foreign_chn_exit) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_FOREIGN_CHANNEL_EXIT; |
| if (param->scan_ev_suspended) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_SUSPENDED; |
| if (param->scan_ev_resumed) |
| cmd->notify_scan_events |= WMI_SCAN_EVENT_RESUMED; |
| |
| /** Set scan control flags */ |
| cmd->scan_ctrl_flags = 0; |
| if (param->scan_f_passive) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_PASSIVE; |
| if (param->scan_f_strict_passive_pch) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_STRICT_PASSIVE_ON_PCHN; |
| if (param->scan_f_promisc_mode) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FILTER_PROMISCOUS; |
| if (param->scan_f_capture_phy_err) |
| cmd->scan_ctrl_flags |= WMI_SCAN_CAPTURE_PHY_ERROR; |
| if (param->scan_f_half_rate) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_HALF_RATE_SUPPORT; |
| if (param->scan_f_quarter_rate) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_QUARTER_RATE_SUPPORT; |
| if (param->scan_f_cck_rates) |
| cmd->scan_ctrl_flags |= WMI_SCAN_ADD_CCK_RATES; |
| if (param->scan_f_ofdm_rates) |
| cmd->scan_ctrl_flags |= WMI_SCAN_ADD_OFDM_RATES; |
| if (param->scan_f_chan_stat_evnt) |
| cmd->scan_ctrl_flags |= WMI_SCAN_CHAN_STAT_EVENT; |
| if (param->scan_f_filter_prb_req) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FILTER_PROBE_REQ; |
| if (param->scan_f_bcast_probe) |
| cmd->scan_ctrl_flags |= WMI_SCAN_ADD_BCAST_PROBE_REQ; |
| if (param->scan_f_offchan_mgmt_tx) |
| cmd->scan_ctrl_flags |= WMI_SCAN_OFFCHAN_MGMT_TX; |
| if (param->scan_f_offchan_data_tx) |
| cmd->scan_ctrl_flags |= WMI_SCAN_OFFCHAN_DATA_TX; |
| if (param->scan_f_force_active_dfs_chn) |
| cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_FORCE_ACTIVE_ON_DFS; |
| if (param->scan_f_add_tpc_ie_in_probe) |
| cmd->scan_ctrl_flags |= WMI_SCAN_ADD_TPC_IE_IN_PROBE_REQ; |
| if (param->scan_f_add_ds_ie_in_probe) |
| cmd->scan_ctrl_flags |= WMI_SCAN_ADD_DS_IE_IN_PROBE_REQ; |
| if (param->scan_f_add_spoofed_mac_in_probe) |
| cmd->scan_ctrl_flags |= WMI_SCAN_ADD_SPOOFED_MAC_IN_PROBE_REQ; |
| if (param->scan_f_add_rand_seq_in_probe) |
| cmd->scan_ctrl_flags |= WMI_SCAN_RANDOM_SEQ_NO_IN_PROBE_REQ; |
| if (param->scan_f_en_ie_whitelist_in_probe) |
| cmd->scan_ctrl_flags |= |
| WMI_SCAN_ENABLE_IE_WHTELIST_IN_PROBE_REQ; |
| |
| /* for adaptive scan mode using 3 bits (21 - 23 bits) */ |
| WMI_SCAN_SET_DWELL_MODE(cmd->scan_ctrl_flags, |
| param->adaptive_dwell_time_mode); |
| } |
| |
| /* scan_copy_ie_buffer() - Copy scan ie_data */ |
| static inline void scan_copy_ie_buffer(uint8_t *buf_ptr, |
| struct scan_req_params *params) |
| { |
| qdf_mem_copy(buf_ptr, params->extraie.ptr, params->extraie.len); |
| } |
| |
| /** |
| * wmi_copy_scan_random_mac() - To copy scan randomization attrs to wmi buffer |
| * @mac: random mac addr |
| * @mask: random mac mask |
| * @mac_addr: wmi random mac |
| * @mac_mask: wmi random mac mask |
| * |
| * Return None. |
| */ |
| static inline |
| void wmi_copy_scan_random_mac(uint8_t *mac, uint8_t *mask, |
| wmi_mac_addr *mac_addr, wmi_mac_addr *mac_mask) |
| { |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(mac, mac_addr); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(mask, mac_mask); |
| } |
| |
| /* |
| * wmi_fill_vendor_oui() - fill vendor OUIs |
| * @buf_ptr: pointer to wmi tlv buffer |
| * @num_vendor_oui: number of vendor OUIs to be filled |
| * @param_voui: pointer to OUI buffer |
| * |
| * This function populates the wmi tlv buffer when vendor specific OUIs are |
| * present. |
| * |
| * Return: None |
| */ |
| static inline |
| void wmi_fill_vendor_oui(uint8_t *buf_ptr, uint32_t num_vendor_oui, |
| uint32_t *pvoui) |
| { |
| wmi_vendor_oui *voui = NULL; |
| uint32_t i; |
| |
| voui = (wmi_vendor_oui *)buf_ptr; |
| |
| for (i = 0; i < num_vendor_oui; i++) { |
| WMITLV_SET_HDR(&voui[i].tlv_header, |
| WMITLV_TAG_STRUC_wmi_vendor_oui, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_vendor_oui)); |
| voui[i].oui_type_subtype = pvoui[i]; |
| } |
| } |
| |
| /* |
| * wmi_fill_ie_whitelist_attrs() - fill IE whitelist attrs |
| * @ie_bitmap: output pointer to ie bit map in cmd |
| * @num_vendor_oui: output pointer to num vendor OUIs |
| * @ie_whitelist: input parameter |
| * |
| * This function populates the IE whitelist attrs of scan, pno and |
| * scan oui commands for ie_whitelist parameter. |
| * |
| * Return: None |
| */ |
| static inline |
| void wmi_fill_ie_whitelist_attrs(uint32_t *ie_bitmap, |
| uint32_t *num_vendor_oui, |
| struct probe_req_whitelist_attr *ie_whitelist) |
| { |
| uint32_t i = 0; |
| |
| for (i = 0; i < PROBE_REQ_BITMAP_LEN; i++) |
| ie_bitmap[i] = ie_whitelist->ie_bitmap[i]; |
| |
| *num_vendor_oui = ie_whitelist->num_vendor_oui; |
| } |
| |
| /** |
| * send_scan_start_cmd_tlv() - WMI scan start function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold scan start cmd parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_scan_start_cmd_tlv(wmi_unified_t wmi_handle, |
| struct scan_req_params *params) |
| { |
| int32_t ret = 0; |
| int32_t i; |
| wmi_buf_t wmi_buf; |
| wmi_start_scan_cmd_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| uint32_t *tmp_ptr; |
| wmi_ssid *ssid = NULL; |
| wmi_mac_addr *bssid; |
| int len = sizeof(*cmd); |
| uint8_t extraie_len_with_pad = 0; |
| uint8_t phymode_roundup = 0; |
| struct probe_req_whitelist_attr *ie_whitelist = ¶ms->ie_whitelist; |
| |
| /* Length TLV placeholder for array of uint32_t */ |
| len += WMI_TLV_HDR_SIZE; |
| /* calculate the length of buffer required */ |
| if (params->chan_list.num_chan) |
| len += params->chan_list.num_chan * sizeof(uint32_t); |
| |
| /* Length TLV placeholder for array of wmi_ssid structures */ |
| len += WMI_TLV_HDR_SIZE; |
| if (params->num_ssids) |
| len += params->num_ssids * sizeof(wmi_ssid); |
| |
| /* Length TLV placeholder for array of wmi_mac_addr structures */ |
| len += WMI_TLV_HDR_SIZE; |
| if (params->num_bssid) |
| len += sizeof(wmi_mac_addr) * params->num_bssid; |
| |
| /* Length TLV placeholder for array of bytes */ |
| len += WMI_TLV_HDR_SIZE; |
| if (params->extraie.len) |
| extraie_len_with_pad = |
| roundup(params->extraie.len, sizeof(uint32_t)); |
| len += extraie_len_with_pad; |
| |
| len += WMI_TLV_HDR_SIZE; /* Length of TLV for array of wmi_vendor_oui */ |
| if (ie_whitelist->num_vendor_oui) |
| len += ie_whitelist->num_vendor_oui * sizeof(wmi_vendor_oui); |
| |
| len += WMI_TLV_HDR_SIZE; /* Length of TLV for array of scan phymode */ |
| if (params->scan_f_wide_band) |
| phymode_roundup = |
| qdf_roundup(params->chan_list.num_chan * sizeof(uint8_t), |
| sizeof(uint32_t)); |
| len += phymode_roundup; |
| |
| /* Allocate the memory */ |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGP("%s: failed to allocate memory for start scan cmd", |
| __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| cmd = (wmi_start_scan_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_start_scan_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_start_scan_cmd_fixed_param)); |
| |
| cmd->scan_id = params->scan_id; |
| cmd->scan_req_id = params->scan_req_id; |
| cmd->vdev_id = params->vdev_id; |
| cmd->scan_priority = params->scan_priority; |
| |
| copy_scan_event_cntrl_flags(cmd, params); |
| |
| cmd->dwell_time_active = params->dwell_time_active; |
| cmd->dwell_time_active_2g = params->dwell_time_active_2g; |
| cmd->dwell_time_passive = params->dwell_time_passive; |
| cmd->min_rest_time = params->min_rest_time; |
| cmd->max_rest_time = params->max_rest_time; |
| cmd->repeat_probe_time = params->repeat_probe_time; |
| cmd->probe_spacing_time = params->probe_spacing_time; |
| cmd->idle_time = params->idle_time; |
| cmd->max_scan_time = params->max_scan_time; |
| cmd->probe_delay = params->probe_delay; |
| cmd->burst_duration = params->burst_duration; |
| cmd->num_chan = params->chan_list.num_chan; |
| cmd->num_bssid = params->num_bssid; |
| cmd->num_ssids = params->num_ssids; |
| cmd->ie_len = params->extraie.len; |
| cmd->n_probes = params->n_probes; |
| cmd->scan_ctrl_flags_ext = params->scan_ctrl_flags_ext; |
| |
| WMI_LOGD("scan_ctrl_flags_ext = %x", cmd->scan_ctrl_flags_ext); |
| |
| if (params->scan_random.randomize) |
| wmi_copy_scan_random_mac(params->scan_random.mac_addr, |
| params->scan_random.mac_mask, |
| &cmd->mac_addr, |
| &cmd->mac_mask); |
| |
| if (ie_whitelist->white_list) |
| wmi_fill_ie_whitelist_attrs(cmd->ie_bitmap, |
| &cmd->num_vendor_oui, |
| ie_whitelist); |
| |
| buf_ptr += sizeof(*cmd); |
| tmp_ptr = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < params->chan_list.num_chan; ++i) |
| tmp_ptr[i] = params->chan_list.chan[i].freq; |
| |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_UINT32, |
| (params->chan_list.num_chan * sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE + |
| (params->chan_list.num_chan * sizeof(uint32_t)); |
| |
| if (params->num_ssids > WMI_SCAN_MAX_NUM_SSID) { |
| WMI_LOGE("Invalid value for numSsid"); |
| goto error; |
| } |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (params->num_ssids * sizeof(wmi_ssid))); |
| |
| if (params->num_ssids) { |
| ssid = (wmi_ssid *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < params->num_ssids; ++i) { |
| ssid->ssid_len = params->ssid[i].length; |
| qdf_mem_copy(ssid->ssid, params->ssid[i].ssid, |
| params->ssid[i].length); |
| ssid++; |
| } |
| } |
| buf_ptr += WMI_TLV_HDR_SIZE + (params->num_ssids * sizeof(wmi_ssid)); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (params->num_bssid * sizeof(wmi_mac_addr))); |
| bssid = (wmi_mac_addr *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| |
| if (params->num_bssid) { |
| for (i = 0; i < params->num_bssid; ++i) { |
| WMI_CHAR_ARRAY_TO_MAC_ADDR( |
| ¶ms->bssid_list[i].bytes[0], bssid); |
| bssid++; |
| } |
| } |
| |
| buf_ptr += WMI_TLV_HDR_SIZE + |
| (params->num_bssid * sizeof(wmi_mac_addr)); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, extraie_len_with_pad); |
| if (params->extraie.len) |
| scan_copy_ie_buffer(buf_ptr + WMI_TLV_HDR_SIZE, |
| params); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE + extraie_len_with_pad; |
| |
| /* probe req ie whitelisting */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| ie_whitelist->num_vendor_oui * sizeof(wmi_vendor_oui)); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| if (cmd->num_vendor_oui) { |
| wmi_fill_vendor_oui(buf_ptr, cmd->num_vendor_oui, |
| ie_whitelist->voui); |
| buf_ptr += cmd->num_vendor_oui * sizeof(wmi_vendor_oui); |
| } |
| |
| /* Add phy mode TLV if it's a wide band scan */ |
| if (params->scan_f_wide_band) { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, phymode_roundup); |
| buf_ptr = (uint8_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < params->chan_list.num_chan; ++i) |
| buf_ptr[i] = |
| WMI_SCAN_CHAN_SET_MODE(params->chan_list.chan[i].phymode); |
| buf_ptr += phymode_roundup; |
| } else { |
| /* Add ZERO legth phy mode TLV */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, 0); |
| } |
| |
| wmi_mtrace(WMI_START_SCAN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, wmi_buf, |
| len, WMI_START_SCAN_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to start scan: %d", __func__, ret); |
| wmi_buf_free(wmi_buf); |
| } |
| return ret; |
| error: |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| /** |
| * send_scan_stop_cmd_tlv() - WMI scan start function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold scan cancel cmd parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_scan_stop_cmd_tlv(wmi_unified_t wmi_handle, |
| struct scan_cancel_param *param) |
| { |
| wmi_stop_scan_cmd_fixed_param *cmd; |
| int ret; |
| int len = sizeof(*cmd); |
| wmi_buf_t wmi_buf; |
| |
| /* Allocate the memory */ |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGP("%s: failed to allocate memory for stop scan cmd", |
| __func__); |
| ret = QDF_STATUS_E_NOMEM; |
| goto error; |
| } |
| |
| cmd = (wmi_stop_scan_cmd_fixed_param *) wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_stop_scan_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_stop_scan_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->requestor = param->requester; |
| cmd->scan_id = param->scan_id; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| /* stop the scan with the corresponding scan_id */ |
| if (param->req_type == WLAN_SCAN_CANCEL_PDEV_ALL) { |
| /* Cancelling all scans */ |
| cmd->req_type = WMI_SCAN_STOP_ALL; |
| } else if (param->req_type == WLAN_SCAN_CANCEL_VDEV_ALL) { |
| /* Cancelling VAP scans */ |
| cmd->req_type = WMI_SCN_STOP_VAP_ALL; |
| } else if (param->req_type == WLAN_SCAN_CANCEL_SINGLE) { |
| /* Cancelling specific scan */ |
| cmd->req_type = WMI_SCAN_STOP_ONE; |
| } else { |
| WMI_LOGE("%s: Invalid Command : ", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| wmi_mtrace(WMI_STOP_SCAN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, wmi_buf, |
| len, WMI_STOP_SCAN_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send stop scan: %d", __func__, ret); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| error: |
| return ret; |
| } |
| |
| #ifdef CONFIG_MCL |
| /** |
| * send_scan_chan_list_cmd_tlv() - WMI scan channel list function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold scan channel list parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_scan_chan_list_cmd_tlv(wmi_unified_t wmi_handle, |
| struct scan_chan_list_params *chan_list) |
| { |
| wmi_buf_t buf; |
| QDF_STATUS qdf_status; |
| wmi_scan_chan_list_cmd_fixed_param *cmd; |
| int i; |
| uint8_t *buf_ptr; |
| wmi_channel_param *chan_info, *tchan_info; |
| uint16_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| |
| len += sizeof(wmi_channel) * chan_list->num_scan_chans; |
| 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_scan_chan_list_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_chan_list_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_scan_chan_list_cmd_fixed_param)); |
| |
| WMI_LOGD("no of channels = %d, len = %d", chan_list->num_scan_chans, len); |
| |
| cmd->num_scan_chans = chan_list->num_scan_chans; |
| WMITLV_SET_HDR((buf_ptr + sizeof(wmi_scan_chan_list_cmd_fixed_param)), |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_channel) * chan_list->num_scan_chans); |
| chan_info = (wmi_channel_param *) |
| (buf_ptr + sizeof(*cmd) + WMI_TLV_HDR_SIZE); |
| tchan_info = chan_list->chan_info; |
| |
| for (i = 0; i < chan_list->num_scan_chans; ++i) { |
| WMITLV_SET_HDR(&chan_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| chan_info->mhz = tchan_info->mhz; |
| chan_info->band_center_freq1 = |
| tchan_info->band_center_freq1; |
| chan_info->band_center_freq2 = |
| tchan_info->band_center_freq2; |
| chan_info->info = tchan_info->info; |
| chan_info->reg_info_1 = tchan_info->reg_info_1; |
| chan_info->reg_info_2 = tchan_info->reg_info_2; |
| WMI_LOGD("chan[%d] = %u", i, chan_info->mhz); |
| |
| /*TODO: Set WMI_SET_CHANNEL_MIN_POWER */ |
| /*TODO: Set WMI_SET_CHANNEL_ANTENNA_MAX */ |
| /*TODO: WMI_SET_CHANNEL_REG_CLASSID */ |
| tchan_info++; |
| chan_info++; |
| } |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| chan_list->pdev_id); |
| |
| wmi_mtrace(WMI_SCAN_CHAN_LIST_CMDID, NO_SESSION, 0); |
| qdf_status = wmi_unified_cmd_send(wmi_handle, |
| buf, len, WMI_SCAN_CHAN_LIST_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(qdf_status)) { |
| WMI_LOGE("Failed to send WMI_SCAN_CHAN_LIST_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| return qdf_status; |
| } |
| #else |
| static QDF_STATUS send_scan_chan_list_cmd_tlv(wmi_unified_t wmi_handle, |
| struct scan_chan_list_params *chan_list) |
| { |
| wmi_buf_t buf; |
| QDF_STATUS qdf_status; |
| wmi_scan_chan_list_cmd_fixed_param *cmd; |
| int i; |
| uint8_t *buf_ptr; |
| wmi_channel *chan_info; |
| struct channel_param *tchan_info; |
| uint16_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| |
| len += sizeof(wmi_channel) * chan_list->nallchans; |
| 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_scan_chan_list_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_chan_list_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_scan_chan_list_cmd_fixed_param)); |
| |
| WMI_LOGD("no of channels = %d, len = %d", chan_list->nallchans, len); |
| |
| if (chan_list->append) |
| cmd->flags |= APPEND_TO_EXISTING_CHAN_LIST; |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| chan_list->pdev_id); |
| cmd->num_scan_chans = chan_list->nallchans; |
| WMITLV_SET_HDR((buf_ptr + sizeof(wmi_scan_chan_list_cmd_fixed_param)), |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_channel) * chan_list->nallchans); |
| chan_info = (wmi_channel *) (buf_ptr + sizeof(*cmd) + WMI_TLV_HDR_SIZE); |
| tchan_info = &(chan_list->ch_param[0]); |
| |
| for (i = 0; i < chan_list->nallchans; ++i) { |
| WMITLV_SET_HDR(&chan_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| 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->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); |
| |
| if (tchan_info->half_rate) |
| WMI_SET_CHANNEL_FLAG(chan_info, |
| WMI_CHAN_FLAG_HALF_RATE); |
| |
| if (tchan_info->quarter_rate) |
| WMI_SET_CHANNEL_FLAG(chan_info, |
| WMI_CHAN_FLAG_QUARTER_RATE); |
| |
| /* also fill in power information */ |
| 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_LOGD("chan[%d] = %u", i, chan_info->mhz); |
| |
| tchan_info++; |
| chan_info++; |
| } |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| chan_list->pdev_id); |
| |
| wmi_mtrace(WMI_SCAN_CHAN_LIST_CMDID, cmd->pdev_id, 0); |
| qdf_status = wmi_unified_cmd_send( |
| wmi_handle, |
| buf, len, WMI_SCAN_CHAN_LIST_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(qdf_status)) { |
| WMI_LOGE("Failed to send WMI_SCAN_CHAN_LIST_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| return qdf_status; |
| } |
| #endif |
| |
| /** |
| * populate_tx_send_params - Populate TX param TLV for mgmt and offchan tx |
| * |
| * @bufp: Pointer to buffer |
| * @param: Pointer to tx param |
| * |
| * Return: QDF_STATUS_SUCCESS for success and QDF_STATUS_E_FAILURE for failure |
| */ |
| static inline QDF_STATUS populate_tx_send_params(uint8_t *bufp, |
| struct tx_send_params param) |
| { |
| wmi_tx_send_params *tx_param; |
| QDF_STATUS status = QDF_STATUS_SUCCESS; |
| |
| if (!bufp) { |
| status = QDF_STATUS_E_FAILURE; |
| return status; |
| } |
| tx_param = (wmi_tx_send_params *)bufp; |
| WMITLV_SET_HDR(&tx_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_tx_send_params, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_tx_send_params)); |
| WMI_TX_SEND_PARAM_PWR_SET(tx_param->tx_param_dword0, param.pwr); |
| WMI_TX_SEND_PARAM_MCS_MASK_SET(tx_param->tx_param_dword0, |
| param.mcs_mask); |
| WMI_TX_SEND_PARAM_NSS_MASK_SET(tx_param->tx_param_dword0, |
| param.nss_mask); |
| WMI_TX_SEND_PARAM_RETRY_LIMIT_SET(tx_param->tx_param_dword0, |
| param.retry_limit); |
| WMI_TX_SEND_PARAM_CHAIN_MASK_SET(tx_param->tx_param_dword1, |
| param.chain_mask); |
| WMI_TX_SEND_PARAM_BW_MASK_SET(tx_param->tx_param_dword1, |
| param.bw_mask); |
| WMI_TX_SEND_PARAM_PREAMBLE_SET(tx_param->tx_param_dword1, |
| param.preamble_type); |
| WMI_TX_SEND_PARAM_FRAME_TYPE_SET(tx_param->tx_param_dword1, |
| param.frame_type); |
| |
| return status; |
| } |
| |
| #ifdef CONFIG_HL_SUPPORT |
| /** |
| * send_mgmt_cmd_tlv() - WMI scan start function |
| * @wmi_handle : handle to WMI. |
| * @param : pointer to hold mgmt cmd parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_mgmt_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_mgmt_params *param) |
| { |
| wmi_buf_t buf; |
| uint8_t *bufp; |
| int32_t cmd_len; |
| wmi_mgmt_tx_send_cmd_fixed_param *cmd; |
| int32_t bufp_len = (param->frm_len < mgmt_tx_dl_frm_len) ? param->frm_len : |
| mgmt_tx_dl_frm_len; |
| |
| if (param->frm_len > mgmt_tx_dl_frm_len) { |
| WMI_LOGE("%s:mgmt frame len %u exceeds %u", |
| __func__, param->frm_len, mgmt_tx_dl_frm_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| cmd_len = sizeof(wmi_mgmt_tx_send_cmd_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| roundup(bufp_len, sizeof(uint32_t)); |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_tx_send_params) + cmd_len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_mgmt_tx_send_cmd_fixed_param *)wmi_buf_data(buf); |
| bufp = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_mgmt_tx_send_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_mgmt_tx_send_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| |
| cmd->desc_id = param->desc_id; |
| cmd->chanfreq = param->chanfreq; |
| bufp += sizeof(wmi_mgmt_tx_send_cmd_fixed_param); |
| WMITLV_SET_HDR(bufp, WMITLV_TAG_ARRAY_BYTE, roundup(bufp_len, |
| sizeof(uint32_t))); |
| bufp += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(bufp, param->pdata, bufp_len); |
| |
| cmd->frame_len = param->frm_len; |
| cmd->buf_len = bufp_len; |
| cmd->tx_params_valid = param->tx_params_valid; |
| |
| wmi_mgmt_cmd_record(wmi_handle, WMI_MGMT_TX_SEND_CMDID, |
| bufp, cmd->vdev_id, cmd->chanfreq); |
| |
| bufp += roundup(bufp_len, sizeof(uint32_t)); |
| if (param->tx_params_valid) { |
| if (populate_tx_send_params(bufp, param->tx_param) != |
| QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: Populate TX send params failed", |
| __func__); |
| goto free_buf; |
| } |
| cmd_len += sizeof(wmi_tx_send_params); |
| } |
| |
| wmi_mtrace(WMI_MGMT_TX_SEND_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, cmd_len, |
| WMI_MGMT_TX_SEND_CMDID)) { |
| WMI_LOGE("%s: Failed to send mgmt Tx", __func__); |
| goto free_buf; |
| } |
| return QDF_STATUS_SUCCESS; |
| |
| free_buf: |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| #else |
| /** |
| * send_mgmt_cmd_tlv() - WMI scan start function |
| * @wmi_handle : handle to WMI. |
| * @param : pointer to hold mgmt cmd parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_mgmt_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_mgmt_params *param) |
| { |
| wmi_buf_t buf; |
| wmi_mgmt_tx_send_cmd_fixed_param *cmd; |
| int32_t cmd_len; |
| uint64_t dma_addr; |
| void *qdf_ctx = param->qdf_ctx; |
| uint8_t *bufp; |
| QDF_STATUS status = QDF_STATUS_SUCCESS; |
| int32_t bufp_len = (param->frm_len < mgmt_tx_dl_frm_len) ? param->frm_len : |
| mgmt_tx_dl_frm_len; |
| |
| cmd_len = sizeof(wmi_mgmt_tx_send_cmd_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| roundup(bufp_len, sizeof(uint32_t)); |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_tx_send_params) + cmd_len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_mgmt_tx_send_cmd_fixed_param *)wmi_buf_data(buf); |
| bufp = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_mgmt_tx_send_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_mgmt_tx_send_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| |
| cmd->desc_id = param->desc_id; |
| cmd->chanfreq = param->chanfreq; |
| bufp += sizeof(wmi_mgmt_tx_send_cmd_fixed_param); |
| WMITLV_SET_HDR(bufp, WMITLV_TAG_ARRAY_BYTE, roundup(bufp_len, |
| sizeof(uint32_t))); |
| bufp += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(bufp, param->pdata, bufp_len); |
| |
| status = qdf_nbuf_map_single(qdf_ctx, param->tx_frame, |
| QDF_DMA_TO_DEVICE); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: wmi buf map failed", __func__); |
| goto free_buf; |
| } |
| |
| dma_addr = qdf_nbuf_get_frag_paddr(param->tx_frame, 0); |
| cmd->paddr_lo = (uint32_t)(dma_addr & 0xffffffff); |
| #if defined(HTT_PADDR64) |
| cmd->paddr_hi = (uint32_t)((dma_addr >> 32) & 0x1F); |
| #endif |
| cmd->frame_len = param->frm_len; |
| cmd->buf_len = bufp_len; |
| cmd->tx_params_valid = param->tx_params_valid; |
| |
| wmi_mgmt_cmd_record(wmi_handle, WMI_MGMT_TX_SEND_CMDID, |
| bufp, cmd->vdev_id, cmd->chanfreq); |
| |
| bufp += roundup(bufp_len, sizeof(uint32_t)); |
| if (param->tx_params_valid) { |
| status = populate_tx_send_params(bufp, param->tx_param); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: Populate TX send params failed", |
| __func__); |
| goto unmap_tx_frame; |
| } |
| cmd_len += sizeof(wmi_tx_send_params); |
| } |
| |
| wmi_mtrace(WMI_MGMT_TX_SEND_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, cmd_len, |
| WMI_MGMT_TX_SEND_CMDID)) { |
| WMI_LOGE("%s: Failed to send mgmt Tx", __func__); |
| goto unmap_tx_frame; |
| } |
| return QDF_STATUS_SUCCESS; |
| |
| unmap_tx_frame: |
| qdf_nbuf_unmap_single(qdf_ctx, param->tx_frame, |
| QDF_DMA_TO_DEVICE); |
| free_buf: |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| #endif /* CONFIG_HL_SUPPORT */ |
| |
| /** |
| * send_offchan_data_tx_send_cmd_tlv() - Send off-chan tx data |
| * @wmi_handle : handle to WMI. |
| * @param : pointer to offchan data tx cmd parameter |
| * |
| * Return: QDF_STATUS_SUCCESS on success and error on failure. |
| */ |
| static QDF_STATUS send_offchan_data_tx_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_offchan_data_tx_params *param) |
| { |
| wmi_buf_t buf; |
| wmi_offchan_data_tx_send_cmd_fixed_param *cmd; |
| int32_t cmd_len; |
| uint64_t dma_addr; |
| void *qdf_ctx = param->qdf_ctx; |
| uint8_t *bufp; |
| int32_t bufp_len = (param->frm_len < mgmt_tx_dl_frm_len) ? |
| param->frm_len : mgmt_tx_dl_frm_len; |
| QDF_STATUS status = QDF_STATUS_SUCCESS; |
| |
| cmd_len = sizeof(wmi_offchan_data_tx_send_cmd_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| roundup(bufp_len, sizeof(uint32_t)); |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_tx_send_params) + cmd_len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_offchan_data_tx_send_cmd_fixed_param *) wmi_buf_data(buf); |
| bufp = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_offchan_data_tx_send_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_offchan_data_tx_send_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| |
| cmd->desc_id = param->desc_id; |
| cmd->chanfreq = param->chanfreq; |
| bufp += sizeof(wmi_offchan_data_tx_send_cmd_fixed_param); |
| WMITLV_SET_HDR(bufp, WMITLV_TAG_ARRAY_BYTE, roundup(bufp_len, |
| sizeof(uint32_t))); |
| bufp += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(bufp, param->pdata, bufp_len); |
| qdf_nbuf_map_single(qdf_ctx, param->tx_frame, QDF_DMA_TO_DEVICE); |
| dma_addr = qdf_nbuf_get_frag_paddr(param->tx_frame, 0); |
| cmd->paddr_lo = (uint32_t)(dma_addr & 0xffffffff); |
| #if defined(HTT_PADDR64) |
| cmd->paddr_hi = (uint32_t)((dma_addr >> 32) & 0x1F); |
| #endif |
| cmd->frame_len = param->frm_len; |
| cmd->buf_len = bufp_len; |
| cmd->tx_params_valid = param->tx_params_valid; |
| |
| wmi_mgmt_cmd_record(wmi_handle, WMI_OFFCHAN_DATA_TX_SEND_CMDID, |
| bufp, cmd->vdev_id, cmd->chanfreq); |
| |
| bufp += roundup(bufp_len, sizeof(uint32_t)); |
| if (param->tx_params_valid) { |
| status = populate_tx_send_params(bufp, param->tx_param); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: Populate TX send params failed", |
| __func__); |
| goto err1; |
| } |
| cmd_len += sizeof(wmi_tx_send_params); |
| } |
| |
| wmi_mtrace(WMI_OFFCHAN_DATA_TX_SEND_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, cmd_len, |
| WMI_OFFCHAN_DATA_TX_SEND_CMDID)) { |
| WMI_LOGE("%s: Failed to offchan data Tx", __func__); |
| goto err1; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| |
| err1: |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| /** |
| * send_modem_power_state_cmd_tlv() - set modem power state to fw |
| * @wmi_handle: wmi handle |
| * @param_value: parameter value |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_modem_power_state_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t param_value) |
| { |
| QDF_STATUS ret; |
| wmi_modem_power_state_cmd_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_modem_power_state_cmd_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_modem_power_state_cmd_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_modem_power_state_cmd_param)); |
| cmd->modem_power_state = param_value; |
| WMI_LOGD("%s: Setting cmd->modem_power_state = %u", __func__, |
| param_value); |
| wmi_mtrace(WMI_MODEM_POWER_STATE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_MODEM_POWER_STATE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send notify cmd ret = %d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_sta_ps_mode_cmd_tlv() - set sta powersave mode in fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @val: value |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code. |
| */ |
| static QDF_STATUS send_set_sta_ps_mode_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t vdev_id, uint8_t val) |
| { |
| wmi_sta_powersave_mode_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| WMI_LOGD("Set Sta Mode Ps vdevId %d val %d", vdev_id, val); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: Set Sta Mode Ps Mem Alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_sta_powersave_mode_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sta_powersave_mode_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sta_powersave_mode_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| if (val) |
| cmd->sta_ps_mode = WMI_STA_PS_MODE_ENABLED; |
| else |
| cmd->sta_ps_mode = WMI_STA_PS_MODE_DISABLED; |
| |
| wmi_mtrace(WMI_STA_POWERSAVE_MODE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_STA_POWERSAVE_MODE_CMDID)) { |
| WMI_LOGE("Set Sta Mode Ps Failed vdevId %d val %d", |
| vdev_id, val); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return 0; |
| } |
| |
| /** |
| * send_set_mimops_cmd_tlv() - set MIMO powersave |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @value: value |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code. |
| */ |
| static QDF_STATUS send_set_mimops_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, int value) |
| { |
| QDF_STATUS ret; |
| wmi_sta_smps_force_mode_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_sta_smps_force_mode_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sta_smps_force_mode_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sta_smps_force_mode_cmd_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| |
| /* WMI_SMPS_FORCED_MODE values do not directly map |
| * to SM power save values defined in the specification. |
| * Make sure to send the right mapping. |
| */ |
| switch (value) { |
| case 0: |
| cmd->forced_mode = WMI_SMPS_FORCED_MODE_NONE; |
| break; |
| case 1: |
| cmd->forced_mode = WMI_SMPS_FORCED_MODE_DISABLED; |
| break; |
| case 2: |
| cmd->forced_mode = WMI_SMPS_FORCED_MODE_STATIC; |
| break; |
| case 3: |
| cmd->forced_mode = WMI_SMPS_FORCED_MODE_DYNAMIC; |
| break; |
| default: |
| WMI_LOGE("%s:INVALID Mimo PS CONFIG", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| WMI_LOGD("Setting vdev %d value = %u", vdev_id, value); |
| |
| wmi_mtrace(WMI_STA_SMPS_FORCE_MODE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_STA_SMPS_FORCE_MODE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send set Mimo PS ret = %d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_smps_params_cmd_tlv() - set smps params |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @value: value |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code. |
| */ |
| static QDF_STATUS send_set_smps_params_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id, |
| int value) |
| { |
| QDF_STATUS ret; |
| wmi_sta_smps_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_sta_smps_param_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sta_smps_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sta_smps_param_cmd_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| cmd->value = value & WMI_SMPS_MASK_LOWER_16BITS; |
| cmd->param = |
| (value >> WMI_SMPS_PARAM_VALUE_S) & WMI_SMPS_MASK_UPPER_3BITS; |
| |
| WMI_LOGD("Setting vdev %d value = %x param %x", vdev_id, cmd->value, |
| cmd->param); |
| |
| wmi_mtrace(WMI_STA_SMPS_PARAM_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_STA_SMPS_PARAM_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send set Mimo PS ret = %d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_p2pgo_noa_req_cmd_tlv() - send p2p go noa request to fw |
| * @wmi_handle: wmi handle |
| * @noa: p2p power save parameters |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_p2pgo_noa_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct p2p_ps_params *noa) |
| { |
| wmi_p2p_set_noa_cmd_fixed_param *cmd; |
| wmi_p2p_noa_descriptor *noa_discriptor; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint16_t len; |
| QDF_STATUS status; |
| uint32_t duration; |
| |
| WMI_LOGD("%s: Enter", __func__); |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + sizeof(*noa_discriptor); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate memory"); |
| status = QDF_STATUS_E_FAILURE; |
| goto end; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_p2p_set_noa_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_p2p_set_noa_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_p2p_set_noa_cmd_fixed_param)); |
| duration = (noa->count == 1) ? noa->single_noa_duration : noa->duration; |
| cmd->vdev_id = noa->session_id; |
| cmd->enable = (duration) ? true : false; |
| cmd->num_noa = 1; |
| |
| WMITLV_SET_HDR((buf_ptr + sizeof(wmi_p2p_set_noa_cmd_fixed_param)), |
| WMITLV_TAG_ARRAY_STRUC, sizeof(wmi_p2p_noa_descriptor)); |
| noa_discriptor = (wmi_p2p_noa_descriptor *) (buf_ptr + |
| sizeof |
| (wmi_p2p_set_noa_cmd_fixed_param) |
| + WMI_TLV_HDR_SIZE); |
| WMITLV_SET_HDR(&noa_discriptor->tlv_header, |
| WMITLV_TAG_STRUC_wmi_p2p_noa_descriptor, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_p2p_noa_descriptor)); |
| noa_discriptor->type_count = noa->count; |
| noa_discriptor->duration = duration; |
| noa_discriptor->interval = noa->interval; |
| noa_discriptor->start_time = 0; |
| |
| WMI_LOGI("SET P2P GO NOA:vdev_id:%d count:%d duration:%d interval:%d", |
| cmd->vdev_id, noa->count, noa_discriptor->duration, |
| noa->interval); |
| wmi_mtrace(WMI_FWTEST_P2P_SET_NOA_PARAM_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_FWTEST_P2P_SET_NOA_PARAM_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("Failed to send WMI_FWTEST_P2P_SET_NOA_PARAM_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| WMI_LOGD("%s: Exit", __func__); |
| return status; |
| } |
| |
| |
| /** |
| * send_set_p2pgo_oppps_req_cmd_tlv() - send p2p go opp power save request to fw |
| * @wmi_handle: wmi handle |
| * @noa: p2p opp power save parameters |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_p2pgo_oppps_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct p2p_ps_params *oppps) |
| { |
| wmi_p2p_set_oppps_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| |
| WMI_LOGD("%s: Enter", __func__); |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate memory"); |
| status = QDF_STATUS_E_FAILURE; |
| goto end; |
| } |
| |
| cmd = (wmi_p2p_set_oppps_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_p2p_set_oppps_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_p2p_set_oppps_cmd_fixed_param)); |
| cmd->vdev_id = oppps->session_id; |
| if (oppps->ctwindow) |
| WMI_UNIFIED_OPPPS_ATTR_ENABLED_SET(cmd); |
| |
| WMI_UNIFIED_OPPPS_ATTR_CTWIN_SET(cmd, oppps->ctwindow); |
| WMI_LOGI("SET P2P GO OPPPS:vdev_id:%d ctwindow:%d", |
| cmd->vdev_id, oppps->ctwindow); |
| wmi_mtrace(WMI_P2P_SET_OPPPS_PARAM_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd), |
| WMI_P2P_SET_OPPPS_PARAM_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("Failed to send WMI_P2P_SET_OPPPS_PARAM_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| WMI_LOGD("%s: Exit", __func__); |
| return status; |
| } |
| |
| #ifdef FEATURE_P2P_LISTEN_OFFLOAD |
| /** |
| * send_p2p_lo_start_cmd_tlv() - send p2p lo start request to fw |
| * @wmi_handle: wmi handle |
| * @param: p2p listen offload start parameters |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_p2p_lo_start_cmd_tlv(wmi_unified_t wmi_handle, |
| struct p2p_lo_start *param) |
| { |
| wmi_buf_t buf; |
| wmi_p2p_lo_start_cmd_fixed_param *cmd; |
| int32_t len = sizeof(*cmd); |
| uint8_t *buf_ptr; |
| QDF_STATUS status; |
| int device_types_len_aligned; |
| int probe_resp_len_aligned; |
| |
| if (!param) { |
| WMI_LOGE("lo start param is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGD("%s: vdev_id:%d", __func__, param->vdev_id); |
| |
| device_types_len_aligned = |
| qdf_roundup(param->dev_types_len, |
| sizeof(uint32_t)); |
| probe_resp_len_aligned = |
| qdf_roundup(param->probe_resp_len, |
| sizeof(uint32_t)); |
| |
| len += 2 * WMI_TLV_HDR_SIZE + device_types_len_aligned + |
| probe_resp_len_aligned; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed to allocate memory for p2p lo start", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_p2p_lo_start_cmd_fixed_param *)wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_p2p_lo_start_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_p2p_lo_start_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| cmd->ctl_flags = param->ctl_flags; |
| cmd->channel = param->freq; |
| cmd->period = param->period; |
| cmd->interval = param->interval; |
| cmd->count = param->count; |
| cmd->device_types_len = param->dev_types_len; |
| cmd->prob_resp_len = param->probe_resp_len; |
| |
| buf_ptr += sizeof(wmi_p2p_lo_start_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| device_types_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, param->device_types, |
| param->dev_types_len); |
| |
| buf_ptr += device_types_len_aligned; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| probe_resp_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, param->probe_resp_tmplt, |
| param->probe_resp_len); |
| |
| WMI_LOGD("%s: Sending WMI_P2P_LO_START command, channel=%d, period=%d, interval=%d, count=%d", __func__, |
| cmd->channel, cmd->period, cmd->interval, cmd->count); |
| |
| wmi_mtrace(WMI_P2P_LISTEN_OFFLOAD_START_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, |
| buf, len, |
| WMI_P2P_LISTEN_OFFLOAD_START_CMDID); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: Failed to send p2p lo start: %d", |
| __func__, status); |
| wmi_buf_free(buf); |
| return status; |
| } |
| |
| WMI_LOGD("%s: Successfully sent WMI_P2P_LO_START", __func__); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_p2p_lo_stop_cmd_tlv() - send p2p lo stop request to fw |
| * @wmi_handle: wmi handle |
| * @param: p2p listen offload stop parameters |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_p2p_lo_stop_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id) |
| { |
| wmi_buf_t buf; |
| wmi_p2p_lo_stop_cmd_fixed_param *cmd; |
| int32_t len; |
| QDF_STATUS status; |
| |
| WMI_LOGD("%s: vdev_id:%d", __func__, vdev_id); |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| qdf_print("%s: Failed to allocate memory for p2p lo stop", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_p2p_lo_stop_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_p2p_lo_stop_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_p2p_lo_stop_cmd_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| |
| WMI_LOGD("%s: Sending WMI_P2P_LO_STOP command", __func__); |
| |
| wmi_mtrace(WMI_P2P_LISTEN_OFFLOAD_STOP_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, |
| buf, len, |
| WMI_P2P_LISTEN_OFFLOAD_STOP_CMDID); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: Failed to send p2p lo stop: %d", |
| __func__, status); |
| wmi_buf_free(buf); |
| return status; |
| } |
| |
| WMI_LOGD("%s: Successfully sent WMI_P2P_LO_STOP", __func__); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif /* End of FEATURE_P2P_LISTEN_OFFLOAD */ |
| |
| /** |
| * send_get_temperature_cmd_tlv() - get pdev temperature req |
| * @wmi_handle: wmi handle |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code. |
| */ |
| static QDF_STATUS send_get_temperature_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_pdev_get_temperature_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len = sizeof(wmi_pdev_get_temperature_cmd_fixed_param); |
| uint8_t *buf_ptr; |
| |
| if (!wmi_handle) { |
| WMI_LOGE(FL("WMI is closed, can not issue cmd")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| |
| cmd = (wmi_pdev_get_temperature_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_get_temperature_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_get_temperature_cmd_fixed_param)); |
| |
| wmi_mtrace(WMI_PDEV_GET_TEMPERATURE_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_PDEV_GET_TEMPERATURE_CMDID)) { |
| WMI_LOGE(FL("failed to send get temperature command")); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_set_sta_uapsd_auto_trig_cmd_tlv() - set uapsd auto trigger command |
| * @wmi_handle: wmi handle |
| * @vdevid: vdev id |
| * @peer_addr: peer mac address |
| * @auto_triggerparam: auto trigger parameters |
| * @num_ac: number of access category |
| * |
| * This function sets the trigger |
| * uapsd params such as service interval, delay interval |
| * and suspend interval which will be used by the firmware |
| * to send trigger frames periodically when there is no |
| * traffic on the transmit side. |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code. |
| */ |
| static QDF_STATUS send_set_sta_uapsd_auto_trig_cmd_tlv(wmi_unified_t wmi_handle, |
| struct sta_uapsd_trig_params *param) |
| { |
| wmi_sta_uapsd_auto_trig_cmd_fixed_param *cmd; |
| QDF_STATUS ret; |
| uint32_t param_len = param->num_ac * sizeof(wmi_sta_uapsd_auto_trig_param); |
| uint32_t cmd_len = sizeof(*cmd) + param_len + WMI_TLV_HDR_SIZE; |
| uint32_t i; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| struct sta_uapsd_params *uapsd_param; |
| wmi_sta_uapsd_auto_trig_param *trig_param; |
| |
| buf = wmi_buf_alloc(wmi_handle, cmd_len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_sta_uapsd_auto_trig_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sta_uapsd_auto_trig_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sta_uapsd_auto_trig_cmd_fixed_param)); |
| cmd->vdev_id = param->vdevid; |
| cmd->num_ac = param->num_ac; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_addr, &cmd->peer_macaddr); |
| |
| /* TLV indicating array of structures to follow */ |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, param_len); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* |
| * Update tag and length for uapsd auto trigger params (this will take |
| * care of updating tag and length if it is not pre-filled by caller). |
| */ |
| uapsd_param = (struct sta_uapsd_params *)param->auto_triggerparam; |
| trig_param = (wmi_sta_uapsd_auto_trig_param *)buf_ptr; |
| for (i = 0; i < param->num_ac; i++) { |
| WMITLV_SET_HDR((buf_ptr + |
| (i * sizeof(wmi_sta_uapsd_auto_trig_param))), |
| WMITLV_TAG_STRUC_wmi_sta_uapsd_auto_trig_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sta_uapsd_auto_trig_param)); |
| trig_param->wmm_ac = uapsd_param->wmm_ac; |
| trig_param->user_priority = uapsd_param->user_priority; |
| trig_param->service_interval = uapsd_param->service_interval; |
| trig_param->suspend_interval = uapsd_param->suspend_interval; |
| trig_param->delay_interval = uapsd_param->delay_interval; |
| trig_param++; |
| uapsd_param++; |
| } |
| |
| wmi_mtrace(WMI_STA_UAPSD_AUTO_TRIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, cmd_len, |
| WMI_STA_UAPSD_AUTO_TRIG_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send set uapsd param ret = %d", ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| #ifdef WLAN_FEATURE_DSRC |
| /** |
| * send_ocb_set_utc_time_cmd() - send the UTC time to the firmware |
| * @wmi_handle: pointer to the wmi handle |
| * @utc: pointer to the UTC time struct |
| * |
| * Return: 0 on succes |
| */ |
| static QDF_STATUS send_ocb_set_utc_time_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ocb_utc_param *utc) |
| { |
| QDF_STATUS ret; |
| wmi_ocb_set_utc_time_cmd_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| uint32_t len, i; |
| wmi_buf_t buf; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_ocb_set_utc_time_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_set_utc_time_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ocb_set_utc_time_cmd_fixed_param)); |
| cmd->vdev_id = utc->vdev_id; |
| |
| for (i = 0; i < SIZE_UTC_TIME; i++) |
| WMI_UTC_TIME_SET(cmd, i, utc->utc_time[i]); |
| |
| for (i = 0; i < SIZE_UTC_TIME_ERROR; i++) |
| WMI_TIME_ERROR_SET(cmd, i, utc->time_error[i]); |
| |
| wmi_mtrace(WMI_OCB_SET_UTC_TIME_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_OCB_SET_UTC_TIME_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to set OCB UTC time")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_ocb_start_timing_advert_cmd_tlv() - start sending the timing advertisement |
| * frames on a channel |
| * @wmi_handle: pointer to the wmi handle |
| * @timing_advert: pointer to the timing advertisement struct |
| * |
| * Return: 0 on succes |
| */ |
| static QDF_STATUS send_ocb_start_timing_advert_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ocb_timing_advert_param *timing_advert) |
| { |
| QDF_STATUS ret; |
| wmi_ocb_start_timing_advert_cmd_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| uint32_t len, len_template; |
| wmi_buf_t buf; |
| |
| len = sizeof(*cmd) + |
| WMI_TLV_HDR_SIZE; |
| |
| len_template = timing_advert->template_length; |
| /* Add padding to the template if needed */ |
| if (len_template % 4 != 0) |
| len_template += 4 - (len_template % 4); |
| len += len_template; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_ocb_start_timing_advert_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_start_timing_advert_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ocb_start_timing_advert_cmd_fixed_param)); |
| cmd->vdev_id = timing_advert->vdev_id; |
| cmd->repeat_rate = timing_advert->repeat_rate; |
| cmd->channel_freq = timing_advert->chan_freq; |
| cmd->timestamp_offset = timing_advert->timestamp_offset; |
| cmd->time_value_offset = timing_advert->time_value_offset; |
| cmd->timing_advert_template_length = timing_advert->template_length; |
| buf_ptr += sizeof(*cmd); |
| |
| /* Add the timing advert template */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| len_template); |
| qdf_mem_copy(buf_ptr + WMI_TLV_HDR_SIZE, |
| (uint8_t *)timing_advert->template_value, |
| timing_advert->template_length); |
| |
| wmi_mtrace(WMI_OCB_START_TIMING_ADVERT_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_OCB_START_TIMING_ADVERT_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to start OCB timing advert")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_ocb_stop_timing_advert_cmd_tlv() - stop sending the timing advertisement frames |
| * on a channel |
| * @wmi_handle: pointer to the wmi handle |
| * @timing_advert: pointer to the timing advertisement struct |
| * |
| * Return: 0 on succes |
| */ |
| static QDF_STATUS send_ocb_stop_timing_advert_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ocb_timing_advert_param *timing_advert) |
| { |
| QDF_STATUS ret; |
| wmi_ocb_stop_timing_advert_cmd_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| uint32_t len; |
| wmi_buf_t buf; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_ocb_stop_timing_advert_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_stop_timing_advert_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ocb_stop_timing_advert_cmd_fixed_param)); |
| cmd->vdev_id = timing_advert->vdev_id; |
| cmd->channel_freq = timing_advert->chan_freq; |
| |
| wmi_mtrace(WMI_OCB_STOP_TIMING_ADVERT_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_OCB_STOP_TIMING_ADVERT_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to stop OCB timing advert")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_ocb_get_tsf_timer_cmd_tlv() - get ocb tsf timer val |
| * @wmi_handle: pointer to the wmi handle |
| * @request: pointer to the request |
| * |
| * Return: 0 on succes |
| */ |
| static QDF_STATUS send_ocb_get_tsf_timer_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id) |
| { |
| QDF_STATUS ret; |
| wmi_ocb_get_tsf_timer_cmd_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| wmi_buf_t buf; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| |
| cmd = (wmi_ocb_get_tsf_timer_cmd_fixed_param *)buf_ptr; |
| qdf_mem_zero(cmd, len); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_get_tsf_timer_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ocb_get_tsf_timer_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| |
| /* Send the WMI command */ |
| wmi_mtrace(WMI_OCB_GET_TSF_TIMER_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_OCB_GET_TSF_TIMER_CMDID); |
| /* If there is an error, set the completion event */ |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to send WMI message: %d"), ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_dcc_get_stats_cmd_tlv() - get the DCC channel stats |
| * @wmi_handle: pointer to the wmi handle |
| * @get_stats_param: pointer to the dcc stats |
| * |
| * Return: 0 on succes |
| */ |
| static QDF_STATUS send_dcc_get_stats_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ocb_dcc_get_stats_param *get_stats_param) |
| { |
| QDF_STATUS ret; |
| wmi_dcc_get_stats_cmd_fixed_param *cmd; |
| wmi_dcc_channel_stats_request *channel_stats_array; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len; |
| uint32_t i; |
| |
| /* Validate the input */ |
| if (get_stats_param->request_array_len != |
| get_stats_param->channel_count * sizeof(*channel_stats_array)) { |
| WMI_LOGE(FL("Invalid parameter")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| /* Allocate memory for the WMI command */ |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + |
| get_stats_param->request_array_len; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| |
| /* Populate the WMI command */ |
| cmd = (wmi_dcc_get_stats_cmd_fixed_param *)buf_ptr; |
| buf_ptr += sizeof(*cmd); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dcc_get_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_get_stats_cmd_fixed_param)); |
| cmd->vdev_id = get_stats_param->vdev_id; |
| cmd->num_channels = get_stats_param->channel_count; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| get_stats_param->request_array_len); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| channel_stats_array = (wmi_dcc_channel_stats_request *)buf_ptr; |
| qdf_mem_copy(channel_stats_array, get_stats_param->request_array, |
| get_stats_param->request_array_len); |
| for (i = 0; i < cmd->num_channels; i++) |
| WMITLV_SET_HDR(&channel_stats_array[i].tlv_header, |
| WMITLV_TAG_STRUC_wmi_dcc_channel_stats_request, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_channel_stats_request)); |
| |
| /* Send the WMI command */ |
| wmi_mtrace(WMI_DCC_GET_STATS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_DCC_GET_STATS_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to send WMI message: %d"), ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_dcc_clear_stats_cmd_tlv() - command to clear the DCC stats |
| * @wmi_handle: pointer to the wmi handle |
| * @vdev_id: vdev id |
| * @dcc_stats_bitmap: dcc status bitmap |
| * |
| * Return: 0 on succes |
| */ |
| static QDF_STATUS send_dcc_clear_stats_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t vdev_id, uint32_t dcc_stats_bitmap) |
| { |
| QDF_STATUS ret; |
| wmi_dcc_clear_stats_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len; |
| |
| /* Allocate memory for the WMI command */ |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| |
| /* Populate the WMI command */ |
| cmd = (wmi_dcc_clear_stats_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dcc_clear_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_clear_stats_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->dcc_stats_bitmap = dcc_stats_bitmap; |
| |
| /* Send the WMI command */ |
| wmi_mtrace(WMI_DCC_CLEAR_STATS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_DCC_CLEAR_STATS_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to send the WMI command")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_dcc_update_ndl_cmd_tlv() - command to update the NDL data |
| * @wmi_handle: pointer to the wmi handle |
| * @update_ndl_param: pointer to the request parameters |
| * |
| * Return: 0 on success |
| */ |
| static QDF_STATUS send_dcc_update_ndl_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ocb_dcc_update_ndl_param *update_ndl_param) |
| { |
| QDF_STATUS qdf_status; |
| wmi_dcc_update_ndl_cmd_fixed_param *cmd; |
| wmi_dcc_ndl_chan *ndl_chan_array; |
| wmi_dcc_ndl_active_state_config *ndl_active_state_array; |
| uint32_t active_state_count; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len; |
| uint32_t i; |
| |
| /* validate the input */ |
| if (update_ndl_param->dcc_ndl_chan_list_len != |
| update_ndl_param->channel_count * sizeof(*ndl_chan_array)) { |
| WMI_LOGE(FL("Invalid parameter")); |
| return QDF_STATUS_E_INVAL; |
| } |
| active_state_count = 0; |
| ndl_chan_array = update_ndl_param->dcc_ndl_chan_list; |
| for (i = 0; i < update_ndl_param->channel_count; i++) |
| active_state_count += |
| WMI_NDL_NUM_ACTIVE_STATE_GET(&ndl_chan_array[i]); |
| if (update_ndl_param->dcc_ndl_active_state_list_len != |
| active_state_count * sizeof(*ndl_active_state_array)) { |
| WMI_LOGE(FL("Invalid parameter")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| /* Allocate memory for the WMI command */ |
| len = sizeof(*cmd) + |
| WMI_TLV_HDR_SIZE + update_ndl_param->dcc_ndl_chan_list_len + |
| WMI_TLV_HDR_SIZE + |
| update_ndl_param->dcc_ndl_active_state_list_len; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| |
| /* Populate the WMI command */ |
| cmd = (wmi_dcc_update_ndl_cmd_fixed_param *)buf_ptr; |
| buf_ptr += sizeof(*cmd); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dcc_update_ndl_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_update_ndl_cmd_fixed_param)); |
| cmd->vdev_id = update_ndl_param->vdev_id; |
| cmd->num_channel = update_ndl_param->channel_count; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| update_ndl_param->dcc_ndl_chan_list_len); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| ndl_chan_array = (wmi_dcc_ndl_chan *)buf_ptr; |
| qdf_mem_copy(ndl_chan_array, update_ndl_param->dcc_ndl_chan_list, |
| update_ndl_param->dcc_ndl_chan_list_len); |
| for (i = 0; i < cmd->num_channel; i++) |
| WMITLV_SET_HDR(&ndl_chan_array[i].tlv_header, |
| WMITLV_TAG_STRUC_wmi_dcc_ndl_chan, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_ndl_chan)); |
| buf_ptr += update_ndl_param->dcc_ndl_chan_list_len; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| update_ndl_param->dcc_ndl_active_state_list_len); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| ndl_active_state_array = (wmi_dcc_ndl_active_state_config *) buf_ptr; |
| qdf_mem_copy(ndl_active_state_array, |
| update_ndl_param->dcc_ndl_active_state_list, |
| update_ndl_param->dcc_ndl_active_state_list_len); |
| for (i = 0; i < active_state_count; i++) { |
| WMITLV_SET_HDR(&ndl_active_state_array[i].tlv_header, |
| WMITLV_TAG_STRUC_wmi_dcc_ndl_active_state_config, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_ndl_active_state_config)); |
| } |
| buf_ptr += update_ndl_param->dcc_ndl_active_state_list_len; |
| |
| /* Send the WMI command */ |
| wmi_mtrace(WMI_DCC_UPDATE_NDL_CMDID, cmd->vdev_id, 0); |
| qdf_status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_DCC_UPDATE_NDL_CMDID); |
| /* If there is an error, set the completion event */ |
| if (QDF_IS_STATUS_ERROR(qdf_status)) { |
| WMI_LOGE(FL("Failed to send WMI message: %d"), qdf_status); |
| wmi_buf_free(buf); |
| } |
| |
| return qdf_status; |
| } |
| |
| /** |
| * send_ocb_set_config_cmd_tlv() - send the OCB config to the FW |
| * @wmi_handle: pointer to the wmi handle |
| * @config: the OCB configuration |
| * |
| * Return: 0 on success |
| */ |
| static QDF_STATUS send_ocb_set_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ocb_config *config) |
| { |
| QDF_STATUS ret; |
| wmi_ocb_set_config_cmd_fixed_param *cmd; |
| wmi_channel *chan; |
| wmi_ocb_channel *ocb_chan; |
| wmi_qos_parameter *qos_param; |
| wmi_dcc_ndl_chan *ndl_chan; |
| wmi_dcc_ndl_active_state_config *ndl_active_config; |
| wmi_ocb_schedule_element *sched_elem; |
| uint8_t *buf_ptr; |
| wmi_buf_t buf; |
| int32_t len; |
| int32_t i, j, active_state_count; |
| |
| /* |
| * Validate the dcc_ndl_chan_list_len and count the number of active |
| * states. Validate dcc_ndl_active_state_list_len. |
| */ |
| active_state_count = 0; |
| if (config->dcc_ndl_chan_list_len) { |
| if (!config->dcc_ndl_chan_list || |
| config->dcc_ndl_chan_list_len != |
| config->channel_count * sizeof(wmi_dcc_ndl_chan)) { |
| WMI_LOGE(FL("NDL channel is invalid. List len: %d"), |
| config->dcc_ndl_chan_list_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| for (i = 0, ndl_chan = config->dcc_ndl_chan_list; |
| i < config->channel_count; ++i, ++ndl_chan) |
| active_state_count += |
| WMI_NDL_NUM_ACTIVE_STATE_GET(ndl_chan); |
| |
| if (active_state_count) { |
| if (!config->dcc_ndl_active_state_list || |
| config->dcc_ndl_active_state_list_len != |
| active_state_count * |
| sizeof(wmi_dcc_ndl_active_state_config)) { |
| WMI_LOGE(FL("NDL active state is invalid.")); |
| return QDF_STATUS_E_INVAL; |
| } |
| } |
| } |
| |
| len = sizeof(*cmd) + |
| WMI_TLV_HDR_SIZE + config->channel_count * |
| sizeof(wmi_channel) + |
| WMI_TLV_HDR_SIZE + config->channel_count * |
| sizeof(wmi_ocb_channel) + |
| WMI_TLV_HDR_SIZE + config->channel_count * |
| sizeof(wmi_qos_parameter) * WMI_MAX_NUM_AC + |
| WMI_TLV_HDR_SIZE + config->dcc_ndl_chan_list_len + |
| WMI_TLV_HDR_SIZE + active_state_count * |
| sizeof(wmi_dcc_ndl_active_state_config) + |
| WMI_TLV_HDR_SIZE + config->schedule_size * |
| sizeof(wmi_ocb_schedule_element); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_ocb_set_config_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_set_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ocb_set_config_cmd_fixed_param)); |
| cmd->vdev_id = config->vdev_id; |
| cmd->channel_count = config->channel_count; |
| cmd->schedule_size = config->schedule_size; |
| cmd->flags = config->flags; |
| buf_ptr += sizeof(*cmd); |
| |
| /* Add the wmi_channel info */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| config->channel_count*sizeof(wmi_channel)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = 0; i < config->channel_count; i++) { |
| chan = (wmi_channel *)buf_ptr; |
| WMITLV_SET_HDR(&chan->tlv_header, |
| WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| chan->mhz = config->channels[i].chan_freq; |
| chan->band_center_freq1 = config->channels[i].chan_freq; |
| chan->band_center_freq2 = 0; |
| chan->info = 0; |
| |
| WMI_SET_CHANNEL_MODE(chan, config->channels[i].ch_mode); |
| WMI_SET_CHANNEL_MAX_POWER(chan, config->channels[i].max_pwr); |
| WMI_SET_CHANNEL_MIN_POWER(chan, config->channels[i].min_pwr); |
| WMI_SET_CHANNEL_MAX_TX_POWER(chan, config->channels[i].max_pwr); |
| WMI_SET_CHANNEL_REG_POWER(chan, config->channels[i].reg_pwr); |
| WMI_SET_CHANNEL_ANTENNA_MAX(chan, |
| config->channels[i].antenna_max); |
| |
| if (config->channels[i].bandwidth < 10) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_QUARTER_RATE); |
| else if (config->channels[i].bandwidth < 20) |
| WMI_SET_CHANNEL_FLAG(chan, WMI_CHAN_FLAG_HALF_RATE); |
| buf_ptr += sizeof(*chan); |
| } |
| |
| /* Add the wmi_ocb_channel info */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| config->channel_count*sizeof(wmi_ocb_channel)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = 0; i < config->channel_count; i++) { |
| ocb_chan = (wmi_ocb_channel *)buf_ptr; |
| WMITLV_SET_HDR(&ocb_chan->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ocb_channel)); |
| ocb_chan->bandwidth = config->channels[i].bandwidth; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR( |
| config->channels[i].mac_address.bytes, |
| &ocb_chan->mac_address); |
| buf_ptr += sizeof(*ocb_chan); |
| } |
| |
| /* Add the wmi_qos_parameter info */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| config->channel_count * sizeof(wmi_qos_parameter)*WMI_MAX_NUM_AC); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| /* WMI_MAX_NUM_AC parameters for each channel */ |
| for (i = 0; i < config->channel_count; i++) { |
| for (j = 0; j < WMI_MAX_NUM_AC; j++) { |
| qos_param = (wmi_qos_parameter *)buf_ptr; |
| WMITLV_SET_HDR(&qos_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_qos_parameter, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_qos_parameter)); |
| qos_param->aifsn = |
| config->channels[i].qos_params[j].aifsn; |
| qos_param->cwmin = |
| config->channels[i].qos_params[j].cwmin; |
| qos_param->cwmax = |
| config->channels[i].qos_params[j].cwmax; |
| buf_ptr += sizeof(*qos_param); |
| } |
| } |
| |
| /* Add the wmi_dcc_ndl_chan (per channel) */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| config->dcc_ndl_chan_list_len); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| if (config->dcc_ndl_chan_list_len) { |
| ndl_chan = (wmi_dcc_ndl_chan *)buf_ptr; |
| qdf_mem_copy(ndl_chan, config->dcc_ndl_chan_list, |
| config->dcc_ndl_chan_list_len); |
| for (i = 0; i < config->channel_count; i++) |
| WMITLV_SET_HDR(&(ndl_chan[i].tlv_header), |
| WMITLV_TAG_STRUC_wmi_dcc_ndl_chan, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_dcc_ndl_chan)); |
| buf_ptr += config->dcc_ndl_chan_list_len; |
| } |
| |
| /* Add the wmi_dcc_ndl_active_state_config */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, active_state_count * |
| sizeof(wmi_dcc_ndl_active_state_config)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| if (active_state_count) { |
| ndl_active_config = (wmi_dcc_ndl_active_state_config *)buf_ptr; |
| qdf_mem_copy(ndl_active_config, |
| config->dcc_ndl_active_state_list, |
| active_state_count * sizeof(*ndl_active_config)); |
| for (i = 0; i < active_state_count; ++i) |
| WMITLV_SET_HDR(&(ndl_active_config[i].tlv_header), |
| WMITLV_TAG_STRUC_wmi_dcc_ndl_active_state_config, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_dcc_ndl_active_state_config)); |
| buf_ptr += active_state_count * |
| sizeof(*ndl_active_config); |
| } |
| |
| /* Add the wmi_ocb_schedule_element info */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| config->schedule_size * sizeof(wmi_ocb_schedule_element)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = 0; i < config->schedule_size; i++) { |
| sched_elem = (wmi_ocb_schedule_element *)buf_ptr; |
| WMITLV_SET_HDR(&sched_elem->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ocb_schedule_element, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ocb_schedule_element)); |
| sched_elem->channel_freq = config->schedule[i].chan_freq; |
| sched_elem->total_duration = config->schedule[i].total_duration; |
| sched_elem->guard_interval = config->schedule[i].guard_interval; |
| buf_ptr += sizeof(*sched_elem); |
| } |
| |
| |
| wmi_mtrace(WMI_OCB_SET_CONFIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_OCB_SET_CONFIG_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to set OCB config"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * extract_ocb_channel_config_resp_tlv() - extract ocb channel config resp |
| * @wmi_handle: wmi handle |
| * @evt_buf: wmi event buffer |
| * @status: status buffer |
| * |
| * Return: QDF_STATUS_SUCCESS on success |
| */ |
| static QDF_STATUS extract_ocb_channel_config_resp_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, |
| uint32_t *status) |
| { |
| WMI_OCB_SET_CONFIG_RESP_EVENTID_param_tlvs *param_tlvs; |
| wmi_ocb_set_config_resp_event_fixed_param *fix_param; |
| |
| param_tlvs = evt_buf; |
| fix_param = param_tlvs->fixed_param; |
| |
| *status = fix_param->status; |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_ocb_tsf_timer_tlv() - extract TSF timer from event buffer |
| * @wmi_handle: wmi handle |
| * @evt_buf: wmi event buffer |
| * @resp: response buffer |
| * |
| * Return: QDF_STATUS_SUCCESS on success |
| */ |
| static QDF_STATUS extract_ocb_tsf_timer_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct ocb_get_tsf_timer_response *resp) |
| { |
| WMI_OCB_GET_TSF_TIMER_RESP_EVENTID_param_tlvs *param_tlvs; |
| wmi_ocb_get_tsf_timer_resp_event_fixed_param *fix_param; |
| |
| param_tlvs = evt_buf; |
| fix_param = param_tlvs->fixed_param; |
| resp->vdev_id = fix_param->vdev_id; |
| resp->timer_high = fix_param->tsf_timer_high; |
| resp->timer_low = fix_param->tsf_timer_low; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_ocb_ndl_resp_tlv() - extract TSF timer from event buffer |
| * @wmi_handle: wmi handle |
| * @evt_buf: wmi event buffer |
| * @resp: response buffer |
| * |
| * Return: QDF_STATUS_SUCCESS on success |
| */ |
| static QDF_STATUS extract_ocb_ndl_resp_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct ocb_dcc_update_ndl_response *resp) |
| { |
| WMI_DCC_UPDATE_NDL_RESP_EVENTID_param_tlvs *param_tlvs; |
| wmi_dcc_update_ndl_resp_event_fixed_param *fix_param; |
| |
| param_tlvs = evt_buf; |
| fix_param = param_tlvs->fixed_param; |
| resp->vdev_id = fix_param->vdev_id; |
| resp->status = fix_param->status; |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_ocb_dcc_stats_tlv() - extract DCC stats from event buffer |
| * @wmi_handle: wmi handle |
| * @evt_buf: wmi event buffer |
| * @resp: response buffer |
| * |
| * Since length of stats is variable, buffer for DCC stats will be allocated |
| * in this function. The caller must free the buffer. |
| * |
| * Return: QDF_STATUS_SUCCESS on success |
| */ |
| static QDF_STATUS extract_ocb_dcc_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct ocb_dcc_get_stats_response **resp) |
| { |
| struct ocb_dcc_get_stats_response *response; |
| WMI_DCC_GET_STATS_RESP_EVENTID_param_tlvs *param_tlvs; |
| wmi_dcc_get_stats_resp_event_fixed_param *fix_param; |
| |
| param_tlvs = (WMI_DCC_GET_STATS_RESP_EVENTID_param_tlvs *)evt_buf; |
| fix_param = param_tlvs->fixed_param; |
| |
| /* Allocate and populate the response */ |
| if (fix_param->num_channels > ((WMI_SVC_MSG_MAX_SIZE - |
| sizeof(*fix_param)) / sizeof(wmi_dcc_ndl_stats_per_channel))) { |
| WMI_LOGE("%s: too many channels:%d", __func__, |
| fix_param->num_channels); |
| QDF_ASSERT(0); |
| *resp = NULL; |
| return QDF_STATUS_E_INVAL; |
| } |
| response = qdf_mem_malloc(sizeof(*response) + fix_param->num_channels * |
| sizeof(wmi_dcc_ndl_stats_per_channel)); |
| *resp = response; |
| if (!response) |
| return QDF_STATUS_E_NOMEM; |
| |
| response->vdev_id = fix_param->vdev_id; |
| response->num_channels = fix_param->num_channels; |
| response->channel_stats_array_len = |
| fix_param->num_channels * |
| sizeof(wmi_dcc_ndl_stats_per_channel); |
| response->channel_stats_array = ((uint8_t *)response) + |
| sizeof(*response); |
| qdf_mem_copy(response->channel_stats_array, |
| param_tlvs->stats_per_channel_list, |
| response->channel_stats_array_len); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /** |
| * send_set_enable_disable_mcc_adaptive_scheduler_cmd_tlv() -enable/disable mcc scheduler |
| * @wmi_handle: wmi handle |
| * @mcc_adaptive_scheduler: enable/disable |
| * |
| * This function enable/disable mcc adaptive scheduler in fw. |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_set_enable_disable_mcc_adaptive_scheduler_cmd_tlv( |
| wmi_unified_t wmi_handle, uint32_t mcc_adaptive_scheduler, |
| uint32_t pdev_id) |
| { |
| QDF_STATUS ret; |
| wmi_buf_t buf = 0; |
| wmi_resmgr_adaptive_ocs_enable_disable_cmd_fixed_param *cmd = NULL; |
| uint16_t len = |
| sizeof(wmi_resmgr_adaptive_ocs_enable_disable_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_resmgr_adaptive_ocs_enable_disable_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_resmgr_adaptive_ocs_enable_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_resmgr_adaptive_ocs_enable_disable_cmd_fixed_param)); |
| cmd->enable = mcc_adaptive_scheduler; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(pdev_id); |
| |
| wmi_mtrace(WMI_RESMGR_ADAPTIVE_OCS_ENABLE_DISABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_RESMGR_ADAPTIVE_OCS_ENABLE_DISABLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGP("%s: Failed to send enable/disable MCC" |
| " adaptive scheduler command", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_mcc_channel_time_latency_cmd_tlv() -set MCC channel time latency |
| * @wmi: wmi handle |
| * @mcc_channel: mcc channel |
| * @mcc_channel_time_latency: MCC channel time latency. |
| * |
| * Currently used to set time latency for an MCC vdev/adapter using operating |
| * channel of it and channel number. The info is provided run time using |
| * iwpriv command: iwpriv <wlan0 | p2p0> setMccLatency <latency in ms>. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_mcc_channel_time_latency_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t mcc_channel_freq, uint32_t mcc_channel_time_latency) |
| { |
| QDF_STATUS ret; |
| wmi_buf_t buf = 0; |
| wmi_resmgr_set_chan_latency_cmd_fixed_param *cmdTL = NULL; |
| uint16_t len = 0; |
| uint8_t *buf_ptr = NULL; |
| wmi_resmgr_chan_latency chan_latency; |
| /* Note: we only support MCC time latency for a single channel */ |
| uint32_t num_channels = 1; |
| uint32_t chan1_freq = mcc_channel_freq; |
| uint32_t latency_chan1 = mcc_channel_time_latency; |
| |
| |
| /* If 0ms latency is provided, then FW will set to a default. |
| * Otherwise, latency must be at least 30ms. |
| */ |
| if ((latency_chan1 > 0) && |
| (latency_chan1 < WMI_MCC_MIN_NON_ZERO_CHANNEL_LATENCY)) { |
| WMI_LOGE("%s: Invalid time latency for Channel #1 = %dms " |
| "Minimum is 30ms (or 0 to use default value by " |
| "firmware)", __func__, latency_chan1); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| /* Set WMI CMD for channel time latency here */ |
| len = sizeof(wmi_resmgr_set_chan_latency_cmd_fixed_param) + |
| WMI_TLV_HDR_SIZE + /*Place holder for chan_time_latency array */ |
| num_channels * sizeof(wmi_resmgr_chan_latency); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmdTL = (wmi_resmgr_set_chan_latency_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmdTL->tlv_header, |
| WMITLV_TAG_STRUC_wmi_resmgr_set_chan_latency_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_resmgr_set_chan_latency_cmd_fixed_param)); |
| cmdTL->num_chans = num_channels; |
| /* Update channel time latency information for home channel(s) */ |
| buf_ptr += sizeof(*cmdTL); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| num_channels * sizeof(wmi_resmgr_chan_latency)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| chan_latency.chan_mhz = chan1_freq; |
| chan_latency.latency = latency_chan1; |
| qdf_mem_copy(buf_ptr, &chan_latency, sizeof(chan_latency)); |
| wmi_mtrace(WMI_RESMGR_SET_CHAN_LATENCY_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_RESMGR_SET_CHAN_LATENCY_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send MCC Channel Time Latency command", |
| __func__); |
| wmi_buf_free(buf); |
| QDF_ASSERT(0); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_mcc_channel_time_quota_cmd_tlv() -set MCC channel time quota |
| * @wmi: wmi handle |
| * @adapter_1_chan_number: adapter 1 channel number |
| * @adapter_1_quota: adapter 1 quota |
| * @adapter_2_chan_number: adapter 2 channel number |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_mcc_channel_time_quota_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t adapter_1_chan_freq, |
| uint32_t adapter_1_quota, uint32_t adapter_2_chan_freq) |
| { |
| QDF_STATUS ret; |
| wmi_buf_t buf = 0; |
| uint16_t len = 0; |
| uint8_t *buf_ptr = NULL; |
| wmi_resmgr_set_chan_time_quota_cmd_fixed_param *cmdTQ = NULL; |
| wmi_resmgr_chan_time_quota chan_quota; |
| uint32_t quota_chan1 = adapter_1_quota; |
| /* Knowing quota of 1st chan., derive quota for 2nd chan. */ |
| uint32_t quota_chan2 = 100 - quota_chan1; |
| /* Note: setting time quota for MCC requires info for 2 channels */ |
| uint32_t num_channels = 2; |
| uint32_t chan1_freq = adapter_1_chan_freq; |
| uint32_t chan2_freq = adapter_2_chan_freq; |
| |
| WMI_LOGD("%s: freq1:%dMHz, Quota1:%dms, " |
| "freq2:%dMHz, Quota2:%dms", __func__, |
| chan1_freq, quota_chan1, chan2_freq, |
| quota_chan2); |
| |
| /* |
| * Perform sanity check on time quota values provided. |
| */ |
| if (quota_chan1 < WMI_MCC_MIN_CHANNEL_QUOTA || |
| quota_chan1 > WMI_MCC_MAX_CHANNEL_QUOTA) { |
| WMI_LOGE("%s: Invalid time quota for Channel #1=%dms. Minimum " |
| "is 20ms & maximum is 80ms", __func__, quota_chan1); |
| return QDF_STATUS_E_INVAL; |
| } |
| /* Set WMI CMD for channel time quota here */ |
| len = sizeof(wmi_resmgr_set_chan_time_quota_cmd_fixed_param) + |
| WMI_TLV_HDR_SIZE + /* Place holder for chan_time_quota array */ |
| num_channels * sizeof(wmi_resmgr_chan_time_quota); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| QDF_ASSERT(0); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmdTQ = (wmi_resmgr_set_chan_time_quota_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmdTQ->tlv_header, |
| WMITLV_TAG_STRUC_wmi_resmgr_set_chan_time_quota_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_resmgr_set_chan_time_quota_cmd_fixed_param)); |
| cmdTQ->num_chans = num_channels; |
| |
| /* Update channel time quota information for home channel(s) */ |
| buf_ptr += sizeof(*cmdTQ); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| num_channels * sizeof(wmi_resmgr_chan_time_quota)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| chan_quota.chan_mhz = chan1_freq; |
| chan_quota.channel_time_quota = quota_chan1; |
| qdf_mem_copy(buf_ptr, &chan_quota, sizeof(chan_quota)); |
| /* Construct channel and quota record for the 2nd MCC mode. */ |
| buf_ptr += sizeof(chan_quota); |
| chan_quota.chan_mhz = chan2_freq; |
| chan_quota.channel_time_quota = quota_chan2; |
| qdf_mem_copy(buf_ptr, &chan_quota, sizeof(chan_quota)); |
| |
| wmi_mtrace(WMI_RESMGR_SET_CHAN_TIME_QUOTA_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_RESMGR_SET_CHAN_TIME_QUOTA_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send MCC Channel Time Quota command"); |
| wmi_buf_free(buf); |
| QDF_ASSERT(0); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_thermal_mgmt_cmd_tlv() - set thermal mgmt command to fw |
| * @wmi_handle: Pointer to wmi handle |
| * @thermal_info: Thermal command information |
| * |
| * This function sends the thermal management command |
| * to the firmware |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| */ |
| static QDF_STATUS send_set_thermal_mgmt_cmd_tlv(wmi_unified_t wmi_handle, |
| struct thermal_cmd_params *thermal_info) |
| { |
| wmi_thermal_mgmt_cmd_fixed_param *cmd = NULL; |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| uint32_t len = 0; |
| |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set key cmd"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_thermal_mgmt_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_thermal_mgmt_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_thermal_mgmt_cmd_fixed_param)); |
| |
| cmd->lower_thresh_degreeC = thermal_info->min_temp; |
| cmd->upper_thresh_degreeC = thermal_info->max_temp; |
| cmd->enable = thermal_info->thermal_enable; |
| |
| WMI_LOGE("TM Sending thermal mgmt cmd: low temp %d, upper temp %d, enabled %d", |
| cmd->lower_thresh_degreeC, cmd->upper_thresh_degreeC, cmd->enable); |
| |
| wmi_mtrace(WMI_THERMAL_MGMT_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_THERMAL_MGMT_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| wmi_buf_free(buf); |
| WMI_LOGE("%s:Failed to send thermal mgmt command", __func__); |
| } |
| |
| return status; |
| } |
| |
| |
| /** |
| * send_lro_config_cmd_tlv() - process the LRO config command |
| * @wmi_handle: Pointer to WMI handle |
| * @wmi_lro_cmd: Pointer to LRO configuration parameters |
| * |
| * This function sends down the LRO configuration parameters to |
| * the firmware to enable LRO, sets the TCP flags and sets the |
| * seed values for the toeplitz hash generation |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| */ |
| static QDF_STATUS send_lro_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_lro_config_cmd_t *wmi_lro_cmd) |
| { |
| wmi_lro_info_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set key cmd"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_lro_info_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_lro_info_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_lro_info_cmd_fixed_param)); |
| |
| cmd->lro_enable = wmi_lro_cmd->lro_enable; |
| WMI_LRO_INFO_TCP_FLAG_VALS_SET(cmd->tcp_flag_u32, |
| wmi_lro_cmd->tcp_flag); |
| WMI_LRO_INFO_TCP_FLAGS_MASK_SET(cmd->tcp_flag_u32, |
| wmi_lro_cmd->tcp_flag_mask); |
| cmd->toeplitz_hash_ipv4_0_3 = |
| wmi_lro_cmd->toeplitz_hash_ipv4[0]; |
| cmd->toeplitz_hash_ipv4_4_7 = |
| wmi_lro_cmd->toeplitz_hash_ipv4[1]; |
| cmd->toeplitz_hash_ipv4_8_11 = |
| wmi_lro_cmd->toeplitz_hash_ipv4[2]; |
| cmd->toeplitz_hash_ipv4_12_15 = |
| wmi_lro_cmd->toeplitz_hash_ipv4[3]; |
| cmd->toeplitz_hash_ipv4_16 = |
| wmi_lro_cmd->toeplitz_hash_ipv4[4]; |
| |
| cmd->toeplitz_hash_ipv6_0_3 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[0]; |
| cmd->toeplitz_hash_ipv6_4_7 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[1]; |
| cmd->toeplitz_hash_ipv6_8_11 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[2]; |
| cmd->toeplitz_hash_ipv6_12_15 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[3]; |
| cmd->toeplitz_hash_ipv6_16_19 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[4]; |
| cmd->toeplitz_hash_ipv6_20_23 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[5]; |
| cmd->toeplitz_hash_ipv6_24_27 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[6]; |
| cmd->toeplitz_hash_ipv6_28_31 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[7]; |
| cmd->toeplitz_hash_ipv6_32_35 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[8]; |
| cmd->toeplitz_hash_ipv6_36_39 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[9]; |
| cmd->toeplitz_hash_ipv6_40 = |
| wmi_lro_cmd->toeplitz_hash_ipv6[10]; |
| |
| WMI_LOGD("WMI_LRO_CONFIG: lro_enable %d, tcp_flag 0x%x", |
| cmd->lro_enable, cmd->tcp_flag_u32); |
| |
| wmi_mtrace(WMI_LRO_CONFIG_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), WMI_LRO_CONFIG_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| wmi_buf_free(buf); |
| WMI_LOGE("%s:Failed to send WMI_LRO_CONFIG_CMDID", __func__); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_peer_rate_report_cmd_tlv() - process the peer rate report command |
| * @wmi_handle: Pointer to wmi handle |
| * @rate_report_params: Pointer to peer rate report parameters |
| * |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| */ |
| static QDF_STATUS send_peer_rate_report_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_peer_rate_report_params *rate_report_params) |
| { |
| wmi_peer_set_rate_report_condition_fixed_param *cmd = NULL; |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status = 0; |
| uint32_t len = 0; |
| uint32_t i, j; |
| |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to alloc buf to peer_set_condition cmd\n"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_peer_set_rate_report_condition_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR( |
| &cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_set_rate_report_condition_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_set_rate_report_condition_fixed_param)); |
| |
| cmd->enable_rate_report = rate_report_params->rate_report_enable; |
| cmd->report_backoff_time = rate_report_params->backoff_time; |
| cmd->report_timer_period = rate_report_params->timer_period; |
| for (i = 0; i < PEER_RATE_REPORT_COND_MAX_NUM; i++) { |
| cmd->cond_per_phy[i].val_cond_flags = |
| rate_report_params->report_per_phy[i].cond_flags; |
| cmd->cond_per_phy[i].rate_delta.min_delta = |
| rate_report_params->report_per_phy[i].delta.delta_min; |
| cmd->cond_per_phy[i].rate_delta.percentage = |
| rate_report_params->report_per_phy[i].delta.percent; |
| for (j = 0; j < MAX_NUM_OF_RATE_THRESH; j++) { |
| cmd->cond_per_phy[i].rate_threshold[j] = |
| rate_report_params->report_per_phy[i]. |
| report_rate_threshold[j]; |
| } |
| } |
| |
| WMI_LOGE("%s enable %d backoff_time %d period %d\n", __func__, |
| cmd->enable_rate_report, |
| cmd->report_backoff_time, cmd->report_timer_period); |
| |
| wmi_mtrace(WMI_PEER_SET_RATE_REPORT_CONDITION_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_SET_RATE_REPORT_CONDITION_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| wmi_buf_free(buf); |
| WMI_LOGE("%s:Failed to send peer_set_report_cond command", |
| __func__); |
| } |
| return status; |
| } |
| |
| /** |
| * send_bcn_buf_ll_cmd_tlv() - prepare and send beacon buffer to fw for LL |
| * @wmi_handle: wmi handle |
| * @param: bcn ll cmd parameter |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| */ |
| static QDF_STATUS send_bcn_buf_ll_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_bcn_send_from_host_cmd_fixed_param *param) |
| { |
| wmi_bcn_send_from_host_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| QDF_STATUS ret; |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_bcn_send_from_host_cmd_fixed_param *) wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bcn_send_from_host_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_bcn_send_from_host_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->data_len = param->data_len; |
| cmd->frame_ctrl = param->frame_ctrl; |
| cmd->frag_ptr = param->frag_ptr; |
| cmd->dtim_flag = param->dtim_flag; |
| |
| wmi_mtrace(WMI_PDEV_SEND_BCN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, wmi_buf, sizeof(*cmd), |
| WMI_PDEV_SEND_BCN_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_PDEV_SEND_BCN_CMDID command"); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_sta_sa_query_param_cmd_tlv() - set sta sa query parameters |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @max_retries: max retries |
| * @retry_interval: retry interval |
| * This function sets sta query related parameters in fw. |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| */ |
| |
| static QDF_STATUS send_set_sta_sa_query_param_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, uint32_t max_retries, |
| uint32_t retry_interval) |
| { |
| wmi_buf_t buf; |
| WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param *cmd; |
| int len; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_PMF_OFFLOAD_SET_SA_QUERY_CMD_fixed_param)); |
| |
| |
| cmd->vdev_id = vdev_id; |
| cmd->sa_query_max_retry_count = max_retries; |
| cmd->sa_query_retry_interval = retry_interval; |
| |
| WMI_LOGD(FL("STA sa query: vdev_id:%d interval:%u retry count:%d"), |
| vdev_id, retry_interval, max_retries); |
| |
| wmi_mtrace(WMI_PMF_OFFLOAD_SET_SA_QUERY_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PMF_OFFLOAD_SET_SA_QUERY_CMDID)) { |
| WMI_LOGE(FL("Failed to offload STA SA Query")); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| WMI_LOGD(FL("Exit :")); |
| return 0; |
| } |
| |
| /** |
| * send_set_sta_keep_alive_cmd_tlv() - set sta keep alive parameters |
| * @wmi_handle: wmi handle |
| * @params: sta keep alive parameter |
| * |
| * This function sets keep alive related parameters in fw. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_sta_keep_alive_cmd_tlv(wmi_unified_t wmi_handle, |
| struct sta_params *params) |
| { |
| wmi_buf_t buf; |
| WMI_STA_KEEPALIVE_CMD_fixed_param *cmd; |
| WMI_STA_KEEPALVE_ARP_RESPONSE *arp_rsp; |
| uint8_t *buf_ptr; |
| int len; |
| QDF_STATUS ret; |
| |
| WMI_LOGD("%s: Enter", __func__); |
| |
| len = sizeof(*cmd) + sizeof(*arp_rsp); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("wmi_buf_alloc failed"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (WMI_STA_KEEPALIVE_CMD_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_STA_KEEPALIVE_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_STA_KEEPALIVE_CMD_fixed_param)); |
| cmd->interval = params->timeperiod; |
| cmd->enable = (params->timeperiod) ? 1 : 0; |
| cmd->vdev_id = params->vdev_id; |
| WMI_LOGD("Keep Alive: vdev_id:%d interval:%u method:%d", params->vdev_id, |
| params->timeperiod, params->method); |
| arp_rsp = (WMI_STA_KEEPALVE_ARP_RESPONSE *) (buf_ptr + sizeof(*cmd)); |
| WMITLV_SET_HDR(&arp_rsp->tlv_header, |
| WMITLV_TAG_STRUC_WMI_STA_KEEPALVE_ARP_RESPONSE, |
| WMITLV_GET_STRUCT_TLVLEN(WMI_STA_KEEPALVE_ARP_RESPONSE)); |
| |
| if ((params->method == WMI_KEEP_ALIVE_UNSOLICIT_ARP_RSP) || |
| (params->method == |
| WMI_STA_KEEPALIVE_METHOD_GRATUITOUS_ARP_REQUEST)) { |
| if ((NULL == params->hostv4addr) || |
| (NULL == params->destv4addr) || |
| (NULL == params->destmac)) { |
| WMI_LOGE("%s: received null pointer, hostv4addr:%pK " |
| "destv4addr:%pK destmac:%pK ", __func__, |
| params->hostv4addr, params->destv4addr, params->destmac); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd->method = params->method; |
| qdf_mem_copy(&arp_rsp->sender_prot_addr, params->hostv4addr, |
| WMI_IPV4_ADDR_LEN); |
| qdf_mem_copy(&arp_rsp->target_prot_addr, params->destv4addr, |
| WMI_IPV4_ADDR_LEN); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(params->destmac, &arp_rsp->dest_mac_addr); |
| } else { |
| cmd->method = WMI_STA_KEEPALIVE_METHOD_NULL_FRAME; |
| } |
| |
| wmi_mtrace(WMI_STA_KEEPALIVE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_STA_KEEPALIVE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to set KeepAlive"); |
| wmi_buf_free(buf); |
| } |
| |
| WMI_LOGD("%s: Exit", __func__); |
| return ret; |
| } |
| |
| /** |
| * send_vdev_set_gtx_cfg_cmd_tlv() - set GTX params |
| * @wmi_handle: wmi handle |
| * @if_id: vdev id |
| * @gtx_info: GTX config params |
| * |
| * This function set GTX related params in firmware. |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_vdev_set_gtx_cfg_cmd_tlv(wmi_unified_t wmi_handle, uint32_t if_id, |
| struct wmi_gtx_config *gtx_info) |
| { |
| wmi_vdev_set_gtx_params_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int len = sizeof(wmi_vdev_set_gtx_params_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_vdev_set_gtx_params_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_gtx_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_set_gtx_params_cmd_fixed_param)); |
| cmd->vdev_id = if_id; |
| |
| cmd->gtxRTMask[0] = gtx_info->gtx_rt_mask[0]; |
| cmd->gtxRTMask[1] = gtx_info->gtx_rt_mask[1]; |
| cmd->userGtxMask = gtx_info->gtx_usrcfg; |
| cmd->gtxPERThreshold = gtx_info->gtx_threshold; |
| cmd->gtxPERMargin = gtx_info->gtx_margin; |
| cmd->gtxTPCstep = gtx_info->gtx_tpcstep; |
| cmd->gtxTPCMin = gtx_info->gtx_tpcmin; |
| cmd->gtxBWMask = gtx_info->gtx_bwmask; |
| |
| WMI_LOGD("Setting vdev%d GTX values:htmcs 0x%x, vhtmcs 0x%x, usermask 0x%x, \ |
| gtxPERThreshold %d, gtxPERMargin %d, gtxTPCstep %d, gtxTPCMin %d, \ |
| gtxBWMask 0x%x.", if_id, cmd->gtxRTMask[0], cmd->gtxRTMask[1], |
| cmd->userGtxMask, cmd->gtxPERThreshold, cmd->gtxPERMargin, |
| cmd->gtxTPCstep, cmd->gtxTPCMin, cmd->gtxBWMask); |
| |
| wmi_mtrace(WMI_VDEV_SET_GTX_PARAMS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SET_GTX_PARAMS_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to set GTX PARAMS"); |
| wmi_buf_free(buf); |
| } |
| return ret; |
| } |
| |
| /** |
| * send_process_update_edca_param_cmd_tlv() - update EDCA params |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id. |
| * @wmm_vparams: edca parameters |
| * |
| * This function updates EDCA parameters to the target |
| * |
| * Return: CDF Status |
| */ |
| static QDF_STATUS send_process_update_edca_param_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, bool mu_edca_param, |
| struct wmi_host_wme_vparams wmm_vparams[WMI_MAX_NUM_AC]) |
| { |
| uint8_t *buf_ptr; |
| wmi_buf_t buf; |
| wmi_vdev_set_wmm_params_cmd_fixed_param *cmd; |
| wmi_wmm_vparams *wmm_param; |
| struct wmi_host_wme_vparams *twmm_param; |
| int len = sizeof(*cmd); |
| int ac; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_vdev_set_wmm_params_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_wmm_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_set_wmm_params_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->wmm_param_type = mu_edca_param; |
| |
| for (ac = 0; ac < WMI_MAX_NUM_AC; ac++) { |
| wmm_param = (wmi_wmm_vparams *) (&cmd->wmm_params[ac]); |
| twmm_param = (struct wmi_host_wme_vparams *) (&wmm_vparams[ac]); |
| WMITLV_SET_HDR(&wmm_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_wmm_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_wmm_vparams)); |
| wmm_param->cwmin = twmm_param->cwmin; |
| wmm_param->cwmax = twmm_param->cwmax; |
| wmm_param->aifs = twmm_param->aifs; |
| if (mu_edca_param) |
| wmm_param->mu_edca_timer = twmm_param->mu_edca_timer; |
| else |
| wmm_param->txoplimit = twmm_param->txoplimit; |
| wmm_param->acm = twmm_param->acm; |
| wmm_param->no_ack = twmm_param->noackpolicy; |
| } |
| |
| wmi_mtrace(WMI_VDEV_SET_WMM_PARAMS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SET_WMM_PARAMS_CMDID)) |
| goto fail; |
| |
| return QDF_STATUS_SUCCESS; |
| |
| fail: |
| wmi_buf_free(buf); |
| WMI_LOGE("%s: Failed to set WMM Paremeters", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| /** |
| * send_probe_rsp_tmpl_send_cmd_tlv() - send probe response template to fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @probe_rsp_info: probe response info |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_probe_rsp_tmpl_send_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, |
| struct wmi_probe_resp_params *probe_rsp_info) |
| { |
| wmi_prb_tmpl_cmd_fixed_param *cmd; |
| wmi_bcn_prb_info *bcn_prb_info; |
| wmi_buf_t wmi_buf; |
| uint32_t tmpl_len, tmpl_len_aligned, wmi_buf_len; |
| uint8_t *buf_ptr; |
| QDF_STATUS ret; |
| |
| WMI_LOGD(FL("Send probe response template for vdev %d"), vdev_id); |
| |
| tmpl_len = probe_rsp_info->prb_rsp_template_len; |
| tmpl_len_aligned = roundup(tmpl_len, sizeof(uint32_t)); |
| |
| wmi_buf_len = sizeof(wmi_prb_tmpl_cmd_fixed_param) + |
| sizeof(wmi_bcn_prb_info) + WMI_TLV_HDR_SIZE + |
| tmpl_len_aligned; |
| |
| if (wmi_buf_len > WMI_BEACON_TX_BUFFER_SIZE) { |
| WMI_LOGE(FL("wmi_buf_len: %d > %d. Can't send wmi cmd"), |
| wmi_buf_len, WMI_BEACON_TX_BUFFER_SIZE); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, wmi_buf_len); |
| if (!wmi_buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| |
| cmd = (wmi_prb_tmpl_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_prb_tmpl_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_prb_tmpl_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->buf_len = tmpl_len; |
| buf_ptr += sizeof(wmi_prb_tmpl_cmd_fixed_param); |
| |
| bcn_prb_info = (wmi_bcn_prb_info *) buf_ptr; |
| WMITLV_SET_HDR(&bcn_prb_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bcn_prb_info, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_bcn_prb_info)); |
| bcn_prb_info->caps = 0; |
| bcn_prb_info->erp = 0; |
| buf_ptr += sizeof(wmi_bcn_prb_info); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, tmpl_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, probe_rsp_info->prb_rsp_template_frm, tmpl_len); |
| |
| wmi_mtrace(WMI_PRB_TMPL_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| wmi_buf, wmi_buf_len, WMI_PRB_TMPL_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to send PRB RSP tmpl: %d"), ret); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| return ret; |
| } |
| |
| #if defined(ATH_SUPPORT_WAPI) || defined(FEATURE_WLAN_WAPI) |
| #define WPI_IV_LEN 16 |
| |
| /** |
| * wmi_update_wpi_key_counter() - update WAPI tsc and rsc key counters |
| * |
| * @dest_tx: destination address of tsc key counter |
| * @src_tx: source address of tsc key counter |
| * @dest_rx: destination address of rsc key counter |
| * @src_rx: source address of rsc key counter |
| * |
| * This function copies WAPI tsc and rsc key counters in the wmi buffer. |
| * |
| * Return: None |
| * |
| */ |
| static void wmi_update_wpi_key_counter(uint8_t *dest_tx, uint8_t *src_tx, |
| uint8_t *dest_rx, uint8_t *src_rx) |
| { |
| qdf_mem_copy(dest_tx, src_tx, WPI_IV_LEN); |
| qdf_mem_copy(dest_rx, src_rx, WPI_IV_LEN); |
| } |
| #else |
| static void wmi_update_wpi_key_counter(uint8_t *dest_tx, uint8_t *src_tx, |
| uint8_t *dest_rx, uint8_t *src_rx) |
| { |
| return; |
| } |
| #endif |
| |
| /** |
| * send_setup_install_key_cmd_tlv() - set key parameters |
| * @wmi_handle: wmi handle |
| * @key_params: key parameters |
| * |
| * This function fills structure from information |
| * passed in key_params. |
| * |
| * Return: QDF_STATUS_SUCCESS - success |
| * QDF_STATUS_E_FAILURE - failure |
| * QDF_STATUS_E_NOMEM - not able to allocate buffer |
| */ |
| static QDF_STATUS send_setup_install_key_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_key_params *key_params) |
| { |
| wmi_vdev_install_key_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len; |
| uint8_t *key_data; |
| QDF_STATUS status; |
| |
| len = sizeof(*cmd) + roundup(key_params->key_len, sizeof(uint32_t)) + |
| WMI_TLV_HDR_SIZE; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set key cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_vdev_install_key_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_install_key_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_install_key_cmd_fixed_param)); |
| cmd->vdev_id = key_params->vdev_id; |
| cmd->key_ix = key_params->key_idx; |
| |
| |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(key_params->peer_mac, &cmd->peer_macaddr); |
| cmd->key_flags |= key_params->key_flags; |
| cmd->key_cipher = key_params->key_cipher; |
| if ((key_params->key_txmic_len) && |
| (key_params->key_rxmic_len)) { |
| cmd->key_txmic_len = key_params->key_txmic_len; |
| cmd->key_rxmic_len = key_params->key_rxmic_len; |
| } |
| #if defined(ATH_SUPPORT_WAPI) || defined(FEATURE_WLAN_WAPI) |
| wmi_update_wpi_key_counter(cmd->wpi_key_tsc_counter, |
| key_params->tx_iv, |
| cmd->wpi_key_rsc_counter, |
| key_params->rx_iv); |
| #endif |
| buf_ptr += sizeof(wmi_vdev_install_key_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| roundup(key_params->key_len, sizeof(uint32_t))); |
| key_data = (uint8_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| qdf_mem_copy((void *)key_data, |
| (const void *)key_params->key_data, key_params->key_len); |
| if (key_params->key_rsc_counter) |
| qdf_mem_copy(&cmd->key_rsc_counter, key_params->key_rsc_counter, |
| sizeof(wmi_key_seq_counter)); |
| cmd->key_len = key_params->key_len; |
| |
| wmi_mtrace(WMI_VDEV_INSTALL_KEY_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_INSTALL_KEY_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_sar_limit_cmd_tlv() - send sar limit cmd to fw |
| * @wmi_handle: wmi handle |
| * @params: sar limit params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_sar_limit_cmd_tlv(wmi_unified_t wmi_handle, |
| struct sar_limit_cmd_params *sar_limit_params) |
| { |
| wmi_buf_t buf; |
| QDF_STATUS qdf_status; |
| wmi_sar_limits_cmd_fixed_param *cmd; |
| int i; |
| uint8_t *buf_ptr; |
| wmi_sar_limit_cmd_row *wmi_sar_rows_list; |
| struct sar_limit_cmd_row *sar_rows_list; |
| uint32_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| |
| len += sizeof(wmi_sar_limit_cmd_row) * sar_limit_params->num_limit_rows; |
| 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_sar_limits_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sar_limits_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sar_limits_cmd_fixed_param)); |
| cmd->sar_enable = sar_limit_params->sar_enable; |
| cmd->commit_limits = sar_limit_params->commit_limits; |
| cmd->num_limit_rows = sar_limit_params->num_limit_rows; |
| |
| WMI_LOGD("no of sar rows = %d, len = %d", |
| sar_limit_params->num_limit_rows, len); |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_sar_limit_cmd_row) * |
| sar_limit_params->num_limit_rows); |
| if (cmd->num_limit_rows == 0) |
| goto send_sar_limits; |
| |
| wmi_sar_rows_list = (wmi_sar_limit_cmd_row *) |
| (buf_ptr + WMI_TLV_HDR_SIZE); |
| sar_rows_list = sar_limit_params->sar_limit_row_list; |
| |
| for (i = 0; i < sar_limit_params->num_limit_rows; i++) { |
| WMITLV_SET_HDR(&wmi_sar_rows_list->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sar_limit_cmd_row, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_sar_limit_cmd_row)); |
| wmi_sar_rows_list->band_id = sar_rows_list->band_id; |
| wmi_sar_rows_list->chain_id = sar_rows_list->chain_id; |
| wmi_sar_rows_list->mod_id = sar_rows_list->mod_id; |
| wmi_sar_rows_list->limit_value = sar_rows_list->limit_value; |
| wmi_sar_rows_list->validity_bitmap = |
| sar_rows_list->validity_bitmap; |
| WMI_LOGD("row %d, band_id = %d, chain_id = %d, mod_id = %d, limit_value = %d, validity_bitmap = %d", |
| i, wmi_sar_rows_list->band_id, |
| wmi_sar_rows_list->chain_id, |
| wmi_sar_rows_list->mod_id, |
| wmi_sar_rows_list->limit_value, |
| wmi_sar_rows_list->validity_bitmap); |
| sar_rows_list++; |
| wmi_sar_rows_list++; |
| } |
| send_sar_limits: |
| wmi_mtrace(WMI_SAR_LIMITS_CMDID, NO_SESSION, 0); |
| qdf_status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_SAR_LIMITS_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(qdf_status)) { |
| WMI_LOGE("Failed to send WMI_SAR_LIMITS_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| return qdf_status; |
| } |
| |
| static QDF_STATUS get_sar_limit_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_sar_get_limits_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len; |
| QDF_STATUS status; |
| |
| WMI_LOGD(FL("Enter")); |
| |
| len = sizeof(*cmd); |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGP(FL("failed to allocate memory for msg")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_sar_get_limits_cmd_fixed_param *)wmi_buf_data(wmi_buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sar_get_limits_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sar_get_limits_cmd_fixed_param)); |
| |
| cmd->reserved = 0; |
| |
| wmi_mtrace(WMI_SAR_GET_LIMITS_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_SAR_GET_LIMITS_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE(FL("Failed to send get SAR limit cmd: %d"), status); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| WMI_LOGD(FL("Exit")); |
| |
| return status; |
| } |
| |
| /** |
| * wmi_sar2_result_string() - return string conversion of sar2 result |
| * @result: sar2 result value |
| * |
| * This utility function helps log string conversion of sar2 result. |
| * |
| * Return: string conversion of sar 2 result, if match found; |
| * "Unknown response" otherwise. |
| */ |
| static const char *wmi_sar2_result_string(uint32_t result) |
| { |
| switch (result) { |
| CASE_RETURN_STRING(WMI_SAR2_SUCCESS); |
| CASE_RETURN_STRING(WMI_SAR2_INVALID_ANTENNA_INDEX); |
| CASE_RETURN_STRING(WMI_SAR2_INVALID_TABLE_INDEX); |
| CASE_RETURN_STRING(WMI_SAR2_STATE_ERROR); |
| CASE_RETURN_STRING(WMI_SAR2_BDF_NO_TABLE); |
| default: |
| return "Unknown response"; |
| } |
| } |
| |
| /** |
| * extract_sar2_result_event_tlv() - process sar response event from FW. |
| * @handle: wma handle |
| * @event: event buffer |
| * @len: buffer length |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS extract_sar2_result_event_tlv(void *handle, |
| uint8_t *event, |
| uint32_t len) |
| { |
| wmi_sar2_result_event_fixed_param *sar2_fixed_param; |
| |
| WMI_SAR2_RESULT_EVENTID_param_tlvs *param_buf = |
| (WMI_SAR2_RESULT_EVENTID_param_tlvs *)event; |
| |
| if (!param_buf) { |
| WMI_LOGI("Invalid sar2 result event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| sar2_fixed_param = param_buf->fixed_param; |
| if (!sar2_fixed_param) { |
| WMI_LOGI("Invalid sar2 result event fixed param buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGI("SAR2 result: %s", |
| wmi_sar2_result_string(sar2_fixed_param->result)); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_sar_limit_event_tlv(wmi_unified_t wmi_handle, |
| uint8_t *evt_buf, |
| struct sar_limit_event *event) |
| { |
| wmi_sar_get_limits_event_fixed_param *fixed_param; |
| WMI_SAR_GET_LIMITS_EVENTID_param_tlvs *param_buf; |
| wmi_sar_get_limit_event_row *row_in; |
| struct sar_limit_event_row *row_out; |
| uint32_t row; |
| |
| if (!evt_buf) { |
| WMI_LOGE(FL("input event is NULL")); |
| return QDF_STATUS_E_INVAL; |
| } |
| if (!event) { |
| WMI_LOGE(FL("output event is NULL")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| param_buf = (WMI_SAR_GET_LIMITS_EVENTID_param_tlvs *)evt_buf; |
| |
| fixed_param = param_buf->fixed_param; |
| if (!fixed_param) { |
| WMI_LOGE(FL("Invalid fixed param")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| event->sar_enable = fixed_param->sar_enable; |
| event->num_limit_rows = fixed_param->num_limit_rows; |
| |
| if (event->num_limit_rows > param_buf->num_sar_get_limits) { |
| WMI_LOGE(FL("Num rows %d exceeds sar_get_limits rows len %d"), |
| event->num_limit_rows, param_buf->num_sar_get_limits); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (event->num_limit_rows > MAX_SAR_LIMIT_ROWS_SUPPORTED) { |
| QDF_ASSERT(0); |
| WMI_LOGE(FL("Num rows %d exceeds max of %d"), |
| event->num_limit_rows, |
| MAX_SAR_LIMIT_ROWS_SUPPORTED); |
| event->num_limit_rows = MAX_SAR_LIMIT_ROWS_SUPPORTED; |
| } |
| |
| row_in = param_buf->sar_get_limits; |
| row_out = &event->sar_limit_row[0]; |
| for (row = 0; row < event->num_limit_rows; row++) { |
| row_out->band_id = row_in->band_id; |
| row_out->chain_id = row_in->chain_id; |
| row_out->mod_id = row_in->mod_id; |
| row_out->limit_value = row_in->limit_value; |
| row_out++; |
| row_in++; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef WLAN_FEATURE_DISA |
| /** |
| * send_encrypt_decrypt_send_cmd() - send encrypt/decrypt cmd to fw |
| * @wmi_handle: wmi handle |
| * @params: encrypt/decrypt params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static |
| QDF_STATUS send_encrypt_decrypt_send_cmd_tlv(wmi_unified_t wmi_handle, |
| struct disa_encrypt_decrypt_req_params *encrypt_decrypt_params) |
| { |
| wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint8_t *buf_ptr; |
| QDF_STATUS ret; |
| uint32_t len; |
| |
| WMI_LOGD(FL("Send encrypt decrypt cmd")); |
| |
| len = sizeof(*cmd) + |
| roundup(encrypt_decrypt_params->data_len, sizeof(uint32_t)) + |
| WMI_TLV_HDR_SIZE; |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGP("%s: failed to allocate memory for encrypt/decrypt msg", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(wmi_buf); |
| cmd = (wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_encrypt_decrypt_data_req_cmd_fixed_param)); |
| |
| cmd->vdev_id = encrypt_decrypt_params->vdev_id; |
| cmd->key_flag = encrypt_decrypt_params->key_flag; |
| cmd->key_idx = encrypt_decrypt_params->key_idx; |
| cmd->key_cipher = encrypt_decrypt_params->key_cipher; |
| cmd->key_len = encrypt_decrypt_params->key_len; |
| cmd->key_txmic_len = encrypt_decrypt_params->key_txmic_len; |
| cmd->key_rxmic_len = encrypt_decrypt_params->key_rxmic_len; |
| |
| qdf_mem_copy(cmd->key_data, encrypt_decrypt_params->key_data, |
| encrypt_decrypt_params->key_len); |
| |
| qdf_mem_copy(cmd->mac_hdr, encrypt_decrypt_params->mac_header, |
| MAX_MAC_HEADER_LEN); |
| |
| cmd->data_len = encrypt_decrypt_params->data_len; |
| |
| if (cmd->data_len) { |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| roundup(encrypt_decrypt_params->data_len, |
| sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, encrypt_decrypt_params->data, |
| encrypt_decrypt_params->data_len); |
| } |
| |
| /* This conversion is to facilitate data to FW in little endian */ |
| cmd->pn[5] = encrypt_decrypt_params->pn[0]; |
| cmd->pn[4] = encrypt_decrypt_params->pn[1]; |
| cmd->pn[3] = encrypt_decrypt_params->pn[2]; |
| cmd->pn[2] = encrypt_decrypt_params->pn[3]; |
| cmd->pn[1] = encrypt_decrypt_params->pn[4]; |
| cmd->pn[0] = encrypt_decrypt_params->pn[5]; |
| |
| wmi_mtrace(WMI_VDEV_ENCRYPT_DECRYPT_DATA_REQ_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| wmi_buf, len, |
| WMI_VDEV_ENCRYPT_DECRYPT_DATA_REQ_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send ENCRYPT DECRYPT cmd: %d", ret); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * extract_encrypt_decrypt_resp_event_tlv() - extract encrypt decrypt resp |
| * params from event |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @resp: Pointer to hold resp parameters |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static |
| QDF_STATUS extract_encrypt_decrypt_resp_event_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct disa_encrypt_decrypt_resp_params *resp) |
| { |
| WMI_VDEV_ENCRYPT_DECRYPT_DATA_RESP_EVENTID_param_tlvs *param_buf; |
| wmi_vdev_encrypt_decrypt_data_resp_event_fixed_param *data_event; |
| |
| param_buf = evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("encrypt decrypt resp evt_buf is NULL"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| data_event = param_buf->fixed_param; |
| |
| resp->vdev_id = data_event->vdev_id; |
| resp->status = data_event->status; |
| |
| if ((data_event->data_length > param_buf->num_enc80211_frame) || |
| (data_event->data_length > WMI_SVC_MSG_MAX_SIZE - WMI_TLV_HDR_SIZE - |
| sizeof(*data_event))) { |
| WMI_LOGE("FW msg data_len %d more than TLV hdr %d", |
| data_event->data_length, |
| param_buf->num_enc80211_frame); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| resp->data_len = data_event->data_length; |
| |
| if (resp->data_len) |
| resp->data = (uint8_t *)param_buf->enc80211_frame; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /** |
| * send_p2p_go_set_beacon_ie_cmd_tlv() - set beacon IE for p2p go |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @p2p_ie: p2p IE |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_p2p_go_set_beacon_ie_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t vdev_id, uint8_t *p2p_ie) |
| { |
| QDF_STATUS ret; |
| wmi_p2p_go_set_beacon_ie_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t ie_len, ie_len_aligned, wmi_buf_len; |
| uint8_t *buf_ptr; |
| |
| ie_len = (uint32_t) (p2p_ie[1] + 2); |
| |
| /* More than one P2P IE may be included in a single frame. |
| If multiple P2P IEs are present, the complete P2P attribute |
| data consists of the concatenation of the P2P Attribute |
| fields of the P2P IEs. The P2P Attributes field of each |
| P2P IE may be any length up to the maximum (251 octets). |
| In this case host sends one P2P IE to firmware so the length |
| should not exceed more than 251 bytes |
| */ |
| if (ie_len > 251) { |
| WMI_LOGE("%s : invalid p2p ie length %u", __func__, ie_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| ie_len_aligned = roundup(ie_len, sizeof(uint32_t)); |
| |
| wmi_buf_len = |
| sizeof(wmi_p2p_go_set_beacon_ie_fixed_param) + ie_len_aligned + |
| WMI_TLV_HDR_SIZE; |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, wmi_buf_len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| |
| cmd = (wmi_p2p_go_set_beacon_ie_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_p2p_go_set_beacon_ie_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_p2p_go_set_beacon_ie_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->ie_buf_len = ie_len; |
| |
| buf_ptr += sizeof(wmi_p2p_go_set_beacon_ie_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, ie_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, p2p_ie, ie_len); |
| |
| WMI_LOGD("%s: Sending WMI_P2P_GO_SET_BEACON_IE", __func__); |
| |
| wmi_mtrace(WMI_P2P_GO_SET_BEACON_IE, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| wmi_buf, wmi_buf_len, |
| WMI_P2P_GO_SET_BEACON_IE); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send bcn tmpl: %d", ret); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| WMI_LOGD("%s: Successfully sent WMI_P2P_GO_SET_BEACON_IE", __func__); |
| return ret; |
| } |
| |
| /** |
| * send_set_gateway_params_cmd_tlv() - set gateway parameters |
| * @wmi_handle: wmi handle |
| * @req: gateway parameter update request structure |
| * |
| * This function reads the incoming @req and fill in the destination |
| * WMI structure and sends down the gateway configs down to the firmware |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS send_set_gateway_params_cmd_tlv(wmi_unified_t wmi_handle, |
| struct gateway_update_req_param *req) |
| { |
| wmi_roam_subnet_change_config_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_roam_subnet_change_config_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_subnet_change_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_roam_subnet_change_config_fixed_param)); |
| |
| cmd->vdev_id = req->session_id; |
| qdf_mem_copy(&cmd->inet_gw_ip_v4_addr, req->ipv4_addr, |
| QDF_IPV4_ADDR_SIZE); |
| qdf_mem_copy(&cmd->inet_gw_ip_v6_addr, req->ipv6_addr, |
| QDF_IPV6_ADDR_SIZE); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(req->gw_mac_addr.bytes, |
| &cmd->inet_gw_mac_addr); |
| cmd->max_retries = req->max_retries; |
| cmd->timeout = req->timeout; |
| cmd->num_skip_subnet_change_detection_bssid_list = 0; |
| cmd->flag = 0; |
| if (req->ipv4_addr_type) |
| WMI_SET_ROAM_SUBNET_CHANGE_FLAG_IP4_ENABLED(cmd->flag); |
| |
| if (req->ipv6_addr_type) |
| WMI_SET_ROAM_SUBNET_CHANGE_FLAG_IP6_ENABLED(cmd->flag); |
| |
| wmi_mtrace(WMI_ROAM_SUBNET_CHANGE_CONFIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_ROAM_SUBNET_CHANGE_CONFIG_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send gw config parameter to fw, ret: %d", |
| ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_rssi_monitoring_cmd_tlv() - set rssi monitoring |
| * @wmi_handle: wmi handle |
| * @req: rssi monitoring request structure |
| * |
| * This function reads the incoming @req and fill in the destination |
| * WMI structure and send down the rssi monitoring configs down to the firmware |
| * |
| * Return: 0 on success; error number otherwise |
| */ |
| static QDF_STATUS send_set_rssi_monitoring_cmd_tlv(wmi_unified_t wmi_handle, |
| struct rssi_monitor_param *req) |
| { |
| wmi_rssi_breach_monitor_config_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| uint32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_rssi_breach_monitor_config_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_rssi_breach_monitor_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_rssi_breach_monitor_config_fixed_param)); |
| |
| cmd->vdev_id = req->session_id; |
| cmd->request_id = req->request_id; |
| cmd->lo_rssi_reenable_hysteresis = 0; |
| cmd->hi_rssi_reenable_histeresis = 0; |
| cmd->min_report_interval = 0; |
| cmd->max_num_report = 1; |
| if (req->control) { |
| /* enable one threshold for each min/max */ |
| cmd->enabled_bitmap = 0x09; |
| cmd->low_rssi_breach_threshold[0] = req->min_rssi; |
| cmd->hi_rssi_breach_threshold[0] = req->max_rssi; |
| } else { |
| cmd->enabled_bitmap = 0; |
| cmd->low_rssi_breach_threshold[0] = 0; |
| cmd->hi_rssi_breach_threshold[0] = 0; |
| } |
| |
| wmi_mtrace(WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| WMI_LOGD("Sent WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID to FW"); |
| |
| return ret; |
| } |
| |
| /** |
| * send_scan_probe_setoui_cmd_tlv() - set scan probe OUI |
| * @wmi_handle: wmi handle |
| * @psetoui: OUI parameters |
| * |
| * set scan probe OUI parameters in firmware |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_scan_probe_setoui_cmd_tlv(wmi_unified_t wmi_handle, |
| struct scan_mac_oui *psetoui) |
| { |
| wmi_scan_prob_req_oui_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len; |
| uint8_t *buf_ptr; |
| uint32_t *oui_buf; |
| struct probe_req_whitelist_attr *ie_whitelist = &psetoui->ie_whitelist; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + |
| ie_whitelist->num_vendor_oui * sizeof(wmi_vendor_oui); |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| cmd = (wmi_scan_prob_req_oui_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_prob_req_oui_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_scan_prob_req_oui_cmd_fixed_param)); |
| |
| oui_buf = &cmd->prob_req_oui; |
| qdf_mem_zero(oui_buf, sizeof(cmd->prob_req_oui)); |
| *oui_buf = psetoui->oui[0] << 16 | psetoui->oui[1] << 8 |
| | psetoui->oui[2]; |
| WMI_LOGD("%s: wmi:oui received from hdd %08x", __func__, |
| cmd->prob_req_oui); |
| |
| cmd->vdev_id = psetoui->vdev_id; |
| cmd->flags = WMI_SCAN_PROBE_OUI_SPOOFED_MAC_IN_PROBE_REQ; |
| if (psetoui->enb_probe_req_sno_randomization) |
| cmd->flags |= WMI_SCAN_PROBE_OUI_RANDOM_SEQ_NO_IN_PROBE_REQ; |
| |
| if (ie_whitelist->white_list) { |
| wmi_fill_ie_whitelist_attrs(cmd->ie_bitmap, |
| &cmd->num_vendor_oui, |
| ie_whitelist); |
| cmd->flags |= |
| WMI_SCAN_PROBE_OUI_ENABLE_IE_WHITELIST_IN_PROBE_REQ; |
| } |
| |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| ie_whitelist->num_vendor_oui * sizeof(wmi_vendor_oui)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| if (cmd->num_vendor_oui != 0) { |
| wmi_fill_vendor_oui(buf_ptr, cmd->num_vendor_oui, |
| ie_whitelist->voui); |
| buf_ptr += cmd->num_vendor_oui * sizeof(wmi_vendor_oui); |
| } |
| |
| wmi_mtrace(WMI_SCAN_PROB_REQ_OUI_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_SCAN_PROB_REQ_OUI_CMDID)) { |
| WMI_LOGE("%s: failed to send command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #if defined(WLAN_FEATURE_FILS_SK) && defined(WLAN_FEATURE_ROAM_OFFLOAD) |
| /** |
| * wmi_add_fils_tlv() - Add FILS TLV to roam scan offload command |
| * @wmi_handle: wmi handle |
| * @roam_req: Roam scan offload params |
| * @buf_ptr: command buffer to send |
| * @fils_tlv_len: fils tlv length |
| * |
| * Return: Updated buffer pointer |
| */ |
| static uint8_t *wmi_add_fils_tlv(wmi_unified_t wmi_handle, |
| struct roam_offload_scan_params *roam_req, |
| uint8_t *buf_ptr, uint32_t fils_tlv_len) |
| { |
| wmi_roam_fils_offload_tlv_param *fils_tlv; |
| wmi_erp_info *erp_info; |
| struct roam_fils_params *roam_fils_params; |
| |
| if (!roam_req->add_fils_tlv) |
| return buf_ptr; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(*fils_tlv)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| fils_tlv = (wmi_roam_fils_offload_tlv_param *)buf_ptr; |
| WMITLV_SET_HDR(&fils_tlv->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_fils_offload_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_fils_offload_tlv_param)); |
| |
| roam_fils_params = &roam_req->roam_fils_params; |
| erp_info = (wmi_erp_info *)(&fils_tlv->vdev_erp_info); |
| |
| erp_info->username_length = roam_fils_params->username_length; |
| qdf_mem_copy(erp_info->username, roam_fils_params->username, |
| erp_info->username_length); |
| |
| erp_info->next_erp_seq_num = roam_fils_params->next_erp_seq_num; |
| |
| erp_info->rRk_length = roam_fils_params->rrk_length; |
| qdf_mem_copy(erp_info->rRk, roam_fils_params->rrk, |
| erp_info->rRk_length); |
| |
| erp_info->rIk_length = roam_fils_params->rik_length; |
| qdf_mem_copy(erp_info->rIk, roam_fils_params->rik, |
| erp_info->rIk_length); |
| |
| erp_info->realm_len = roam_fils_params->realm_len; |
| qdf_mem_copy(erp_info->realm, roam_fils_params->realm, |
| erp_info->realm_len); |
| |
| buf_ptr += sizeof(*fils_tlv); |
| return buf_ptr; |
| } |
| #else |
| static inline uint8_t *wmi_add_fils_tlv(wmi_unified_t wmi_handle, |
| struct roam_offload_scan_params *roam_req, |
| uint8_t *buf_ptr, uint32_t fils_tlv_len) |
| { |
| return buf_ptr; |
| } |
| #endif |
| /** |
| * send_roam_scan_offload_mode_cmd_tlv() - send roam scan mode request to fw |
| * @wmi_handle: wmi handle |
| * @scan_cmd_fp: start scan command ptr |
| * @roam_req: roam request param |
| * |
| * send WMI_ROAM_SCAN_MODE TLV to firmware. It has a piggyback |
| * of WMI_ROAM_SCAN_MODE. |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_mode_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_start_scan_cmd_fixed_param * |
| scan_cmd_fp, |
| struct roam_offload_scan_params *roam_req) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_scan_mode_fixed_param *roam_scan_mode_fp; |
| |
| #ifdef WLAN_FEATURE_ROAM_OFFLOAD |
| int auth_mode = roam_req->auth_mode; |
| roam_offload_param *req_offload_params = |
| &roam_req->roam_offload_params; |
| wmi_roam_offload_tlv_param *roam_offload_params; |
| wmi_roam_11i_offload_tlv_param *roam_offload_11i; |
| wmi_roam_11r_offload_tlv_param *roam_offload_11r; |
| wmi_roam_ese_offload_tlv_param *roam_offload_ese; |
| wmi_tlv_buf_len_param *assoc_ies; |
| uint32_t fils_tlv_len = 0; |
| #endif /* WLAN_FEATURE_ROAM_OFFLOAD */ |
| /* Need to create a buf with roam_scan command at |
| * front and piggyback with scan command */ |
| len = sizeof(wmi_roam_scan_mode_fixed_param) + |
| #ifdef WLAN_FEATURE_ROAM_OFFLOAD |
| (2 * WMI_TLV_HDR_SIZE) + |
| #endif /* WLAN_FEATURE_ROAM_OFFLOAD */ |
| sizeof(wmi_start_scan_cmd_fixed_param); |
| #ifdef WLAN_FEATURE_ROAM_OFFLOAD |
| WMI_LOGD("auth_mode = %d", auth_mode); |
| if (roam_req->is_roam_req_valid && |
| roam_req->roam_offload_enabled) { |
| len += sizeof(wmi_roam_offload_tlv_param); |
| len += WMI_TLV_HDR_SIZE; |
| if ((auth_mode != WMI_AUTH_NONE) && |
| ((auth_mode != WMI_AUTH_OPEN) || |
| (auth_mode == WMI_AUTH_OPEN && |
| roam_req->mdid.mdie_present && |
| roam_req->is_11r_assoc) || |
| roam_req->is_ese_assoc)) { |
| len += WMI_TLV_HDR_SIZE; |
| if (roam_req->is_ese_assoc) |
| len += |
| sizeof(wmi_roam_ese_offload_tlv_param); |
| else if (auth_mode == WMI_AUTH_FT_RSNA || |
| auth_mode == WMI_AUTH_FT_RSNA_PSK || |
| (auth_mode == WMI_AUTH_OPEN && |
| roam_req->mdid.mdie_present && |
| roam_req->is_11r_assoc)) |
| len += |
| sizeof(wmi_roam_11r_offload_tlv_param); |
| else |
| len += |
| sizeof(wmi_roam_11i_offload_tlv_param); |
| } else { |
| len += WMI_TLV_HDR_SIZE; |
| } |
| |
| len += (sizeof(*assoc_ies) + (2*WMI_TLV_HDR_SIZE) |
| + roundup(roam_req->assoc_ie_length, |
| sizeof(uint32_t))); |
| |
| if (roam_req->add_fils_tlv) { |
| fils_tlv_len = sizeof( |
| wmi_roam_fils_offload_tlv_param); |
| len += WMI_TLV_HDR_SIZE + fils_tlv_len; |
| } |
| } else { |
| if (roam_req->is_roam_req_valid) |
| WMI_LOGD("%s : roam offload = %d", |
| __func__, roam_req->roam_offload_enabled); |
| else |
| WMI_LOGD("%s : roam_req is NULL", __func__); |
| len += (4 * WMI_TLV_HDR_SIZE); |
| } |
| if (roam_req->is_roam_req_valid && |
| roam_req->roam_offload_enabled) { |
| roam_req->mode = roam_req->mode | |
| WMI_ROAM_SCAN_MODE_ROAMOFFLOAD; |
| } |
| #endif /* WLAN_FEATURE_ROAM_OFFLOAD */ |
| |
| if (roam_req->mode == (WMI_ROAM_SCAN_MODE_NONE |
| |WMI_ROAM_SCAN_MODE_ROAMOFFLOAD)) |
| len = sizeof(wmi_roam_scan_mode_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| roam_scan_mode_fp = (wmi_roam_scan_mode_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&roam_scan_mode_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_scan_mode_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_scan_mode_fixed_param)); |
| |
| roam_scan_mode_fp->min_delay_roam_trigger_reason_bitmask = |
| roam_req->roam_trigger_reason_bitmask; |
| roam_scan_mode_fp->min_delay_btw_scans = |
| WMI_SEC_TO_MSEC(roam_req->min_delay_btw_roam_scans); |
| roam_scan_mode_fp->roam_scan_mode = roam_req->mode; |
| roam_scan_mode_fp->vdev_id = roam_req->vdev_id; |
| if (roam_req->mode == (WMI_ROAM_SCAN_MODE_NONE | |
| WMI_ROAM_SCAN_MODE_ROAMOFFLOAD)) { |
| roam_scan_mode_fp->flags |= |
| WMI_ROAM_SCAN_MODE_FLAG_REPORT_STATUS; |
| goto send_roam_scan_mode_cmd; |
| } |
| |
| /* Fill in scan parameters suitable for roaming scan */ |
| buf_ptr += sizeof(wmi_roam_scan_mode_fixed_param); |
| |
| qdf_mem_copy(buf_ptr, scan_cmd_fp, |
| sizeof(wmi_start_scan_cmd_fixed_param)); |
| /* Ensure there is no additional IEs */ |
| scan_cmd_fp->ie_len = 0; |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_STRUC_wmi_start_scan_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_start_scan_cmd_fixed_param)); |
| #ifdef WLAN_FEATURE_ROAM_OFFLOAD |
| buf_ptr += sizeof(wmi_start_scan_cmd_fixed_param); |
| if (roam_req->is_roam_req_valid && roam_req->roam_offload_enabled) { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_offload_tlv_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| roam_offload_params = (wmi_roam_offload_tlv_param *) buf_ptr; |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_STRUC_wmi_roam_offload_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_offload_tlv_param)); |
| roam_offload_params->prefer_5g = roam_req->prefer_5ghz; |
| roam_offload_params->rssi_cat_gap = roam_req->roam_rssi_cat_gap; |
| roam_offload_params->select_5g_margin = |
| roam_req->select_5ghz_margin; |
| roam_offload_params->handoff_delay_for_rx = |
| req_offload_params->ho_delay_for_rx; |
| roam_offload_params->max_mlme_sw_retries = |
| req_offload_params->roam_preauth_retry_count; |
| roam_offload_params->no_ack_timeout = |
| req_offload_params->roam_preauth_no_ack_timeout; |
| roam_offload_params->reassoc_failure_timeout = |
| roam_req->reassoc_failure_timeout; |
| |
| /* Fill the capabilities */ |
| roam_offload_params->capability = |
| req_offload_params->capability; |
| roam_offload_params->ht_caps_info = |
| req_offload_params->ht_caps_info; |
| roam_offload_params->ampdu_param = |
| req_offload_params->ampdu_param; |
| roam_offload_params->ht_ext_cap = |
| req_offload_params->ht_ext_cap; |
| roam_offload_params->ht_txbf = req_offload_params->ht_txbf; |
| roam_offload_params->asel_cap = req_offload_params->asel_cap; |
| roam_offload_params->qos_caps = req_offload_params->qos_caps; |
| roam_offload_params->qos_enabled = |
| req_offload_params->qos_enabled; |
| roam_offload_params->wmm_caps = req_offload_params->wmm_caps; |
| qdf_mem_copy((uint8_t *)roam_offload_params->mcsset, |
| (uint8_t *)req_offload_params->mcsset, |
| ROAM_OFFLOAD_NUM_MCS_SET); |
| |
| buf_ptr += sizeof(wmi_roam_offload_tlv_param); |
| /* The TLV's are in the order of 11i, 11R, ESE. Hence, |
| * they are filled in the same order.Depending on the |
| * authentication type, the other mode TLV's are nullified |
| * and only headers are filled.*/ |
| if ((auth_mode != WMI_AUTH_NONE) && |
| ((auth_mode != WMI_AUTH_OPEN) || |
| (auth_mode == WMI_AUTH_OPEN |
| && roam_req->mdid.mdie_present && |
| roam_req->is_11r_assoc) || |
| roam_req->is_ese_assoc)) { |
| if (roam_req->is_ese_assoc) { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_ese_offload_tlv_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| roam_offload_ese = |
| (wmi_roam_ese_offload_tlv_param *) buf_ptr; |
| qdf_mem_copy(roam_offload_ese->krk, |
| roam_req->krk, |
| sizeof(roam_req->krk)); |
| qdf_mem_copy(roam_offload_ese->btk, |
| roam_req->btk, |
| sizeof(roam_req->btk)); |
| WMITLV_SET_HDR(&roam_offload_ese->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_ese_offload_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_ese_offload_tlv_param)); |
| buf_ptr += |
| sizeof(wmi_roam_ese_offload_tlv_param); |
| } else if (auth_mode == WMI_AUTH_FT_RSNA |
| || auth_mode == WMI_AUTH_FT_RSNA_PSK |
| || (auth_mode == WMI_AUTH_OPEN |
| && roam_req->mdid.mdie_present && |
| roam_req->is_11r_assoc)) { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_11r_offload_tlv_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| roam_offload_11r = |
| (wmi_roam_11r_offload_tlv_param *) buf_ptr; |
| roam_offload_11r->r0kh_id_len = |
| roam_req->rokh_id_length; |
| qdf_mem_copy(roam_offload_11r->r0kh_id, |
| roam_req->rokh_id, |
| roam_offload_11r->r0kh_id_len); |
| qdf_mem_copy(roam_offload_11r->psk_msk, |
| roam_req->psk_pmk, |
| sizeof(roam_req->psk_pmk)); |
| roam_offload_11r->psk_msk_len = |
| roam_req->pmk_len; |
| roam_offload_11r->mdie_present = |
| roam_req->mdid.mdie_present; |
| roam_offload_11r->mdid = |
| roam_req->mdid.mobility_domain; |
| if (auth_mode == WMI_AUTH_OPEN) { |
| /* If FT-Open ensure pmk length |
| and r0khid len are zero */ |
| roam_offload_11r->r0kh_id_len = 0; |
| roam_offload_11r->psk_msk_len = 0; |
| } |
| WMITLV_SET_HDR(&roam_offload_11r->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_11r_offload_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_11r_offload_tlv_param)); |
| buf_ptr += |
| sizeof(wmi_roam_11r_offload_tlv_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMI_LOGD("psk_msk_len = %d", |
| roam_offload_11r->psk_msk_len); |
| if (roam_offload_11r->psk_msk_len) |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, |
| QDF_TRACE_LEVEL_DEBUG, |
| roam_offload_11r->psk_msk, |
| roam_offload_11r->psk_msk_len); |
| } else { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_11i_offload_tlv_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| roam_offload_11i = |
| (wmi_roam_11i_offload_tlv_param *) buf_ptr; |
| |
| if (roam_req->roam_key_mgmt_offload_enabled && |
| roam_req->fw_okc) { |
| WMI_SET_ROAM_OFFLOAD_OKC_ENABLED |
| (roam_offload_11i->flags); |
| WMI_LOGI("LFR3:OKC enabled"); |
| } else { |
| WMI_SET_ROAM_OFFLOAD_OKC_DISABLED |
| (roam_offload_11i->flags); |
| WMI_LOGI("LFR3:OKC disabled"); |
| } |
| if (roam_req->roam_key_mgmt_offload_enabled && |
| roam_req->fw_pmksa_cache) { |
| WMI_SET_ROAM_OFFLOAD_PMK_CACHE_ENABLED |
| (roam_offload_11i->flags); |
| WMI_LOGI("LFR3:PMKSA caching enabled"); |
| } else { |
| WMI_SET_ROAM_OFFLOAD_PMK_CACHE_DISABLED |
| (roam_offload_11i->flags); |
| WMI_LOGI("LFR3:PMKSA caching disabled"); |
| } |
| |
| qdf_mem_copy(roam_offload_11i->pmk, |
| roam_req->psk_pmk, |
| sizeof(roam_req->psk_pmk)); |
| roam_offload_11i->pmk_len = roam_req->pmk_len; |
| WMITLV_SET_HDR(&roam_offload_11i->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_11i_offload_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_11i_offload_tlv_param)); |
| buf_ptr += |
| sizeof(wmi_roam_11i_offload_tlv_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMI_LOGD("pmk_len = %d", |
| roam_offload_11i->pmk_len); |
| if (roam_offload_11i->pmk_len) |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, |
| QDF_TRACE_LEVEL_DEBUG, |
| roam_offload_11i->pmk, |
| roam_offload_11i->pmk_len); |
| } |
| } else { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| } |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(*assoc_ies)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| assoc_ies = (wmi_tlv_buf_len_param *) buf_ptr; |
| WMITLV_SET_HDR(&assoc_ies->tlv_header, |
| WMITLV_TAG_STRUC_wmi_tlv_buf_len_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_tlv_buf_len_param)); |
| assoc_ies->buf_len = roam_req->assoc_ie_length; |
| |
| buf_ptr += sizeof(*assoc_ies); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| roundup(assoc_ies->buf_len, sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| if (assoc_ies->buf_len != 0) { |
| qdf_mem_copy(buf_ptr, roam_req->assoc_ie, |
| assoc_ies->buf_len); |
| } |
| buf_ptr += qdf_roundup(assoc_ies->buf_len, sizeof(uint32_t)); |
| buf_ptr = wmi_add_fils_tlv(wmi_handle, roam_req, |
| buf_ptr, fils_tlv_len); |
| } else { |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| WMITLV_GET_STRUCT_TLVLEN(0)); |
| } |
| #endif /* WLAN_FEATURE_ROAM_OFFLOAD */ |
| |
| send_roam_scan_mode_cmd: |
| wmi_mtrace(WMI_ROAM_SCAN_MODE, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_SCAN_MODE); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE( |
| "wmi_unified_cmd_send WMI_ROAM_SCAN_MODE returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| static QDF_STATUS send_roam_mawc_params_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_mawc_roam_params *params) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_configure_mawc_cmd_fixed_param *wmi_roam_mawc_params; |
| |
| len = sizeof(*wmi_roam_mawc_params); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| wmi_roam_mawc_params = |
| (wmi_roam_configure_mawc_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&wmi_roam_mawc_params->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_configure_mawc_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_configure_mawc_cmd_fixed_param)); |
| wmi_roam_mawc_params->vdev_id = params->vdev_id; |
| if (params->enable) |
| wmi_roam_mawc_params->enable = 1; |
| else |
| wmi_roam_mawc_params->enable = 0; |
| wmi_roam_mawc_params->traffic_load_threshold = |
| params->traffic_load_threshold; |
| wmi_roam_mawc_params->best_ap_rssi_threshold = |
| params->best_ap_rssi_threshold; |
| wmi_roam_mawc_params->rssi_stationary_high_adjust = |
| params->rssi_stationary_high_adjust; |
| wmi_roam_mawc_params->rssi_stationary_low_adjust = |
| params->rssi_stationary_low_adjust; |
| WMI_LOGD(FL("MAWC roam en=%d, vdev=%d, tr=%d, ap=%d, high=%d, low=%d"), |
| wmi_roam_mawc_params->enable, wmi_roam_mawc_params->vdev_id, |
| wmi_roam_mawc_params->traffic_load_threshold, |
| wmi_roam_mawc_params->best_ap_rssi_threshold, |
| wmi_roam_mawc_params->rssi_stationary_high_adjust, |
| wmi_roam_mawc_params->rssi_stationary_low_adjust); |
| |
| wmi_mtrace(WMI_ROAM_CONFIGURE_MAWC_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_CONFIGURE_MAWC_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_ROAM_CONFIGURE_MAWC_CMDID failed, Error %d", |
| status); |
| wmi_buf_free(buf); |
| return status; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_roam_scan_offload_rssi_thresh_cmd_tlv() - set scan offload |
| * rssi threashold |
| * @wmi_handle: wmi handle |
| * @roam_req: Roaming request buffer |
| * |
| * Send WMI_ROAM_SCAN_RSSI_THRESHOLD TLV to firmware |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_rssi_thresh_cmd_tlv(wmi_unified_t wmi_handle, |
| struct roam_offload_scan_rssi_params *roam_req) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_scan_rssi_threshold_fixed_param *rssi_threshold_fp; |
| wmi_roam_scan_extended_threshold_param *ext_thresholds = NULL; |
| wmi_roam_earlystop_rssi_thres_param *early_stop_thresholds = NULL; |
| wmi_roam_dense_thres_param *dense_thresholds = NULL; |
| wmi_roam_bg_scan_roaming_param *bg_scan_params = NULL; |
| |
| len = sizeof(wmi_roam_scan_rssi_threshold_fixed_param); |
| len += WMI_TLV_HDR_SIZE; /* TLV for ext_thresholds*/ |
| len += sizeof(wmi_roam_scan_extended_threshold_param); |
| len += WMI_TLV_HDR_SIZE; |
| len += sizeof(wmi_roam_earlystop_rssi_thres_param); |
| len += WMI_TLV_HDR_SIZE; /* TLV for dense thresholds*/ |
| len += sizeof(wmi_roam_dense_thres_param); |
| len += WMI_TLV_HDR_SIZE; /* TLV for BG Scan*/ |
| len += sizeof(wmi_roam_bg_scan_roaming_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| rssi_threshold_fp = |
| (wmi_roam_scan_rssi_threshold_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&rssi_threshold_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_scan_rssi_threshold_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_scan_rssi_threshold_fixed_param)); |
| /* fill in threshold values */ |
| rssi_threshold_fp->vdev_id = roam_req->session_id; |
| rssi_threshold_fp->roam_scan_rssi_thresh = roam_req->rssi_thresh; |
| rssi_threshold_fp->roam_rssi_thresh_diff = roam_req->rssi_thresh_diff; |
| rssi_threshold_fp->hirssi_scan_max_count = |
| roam_req->hi_rssi_scan_max_count; |
| rssi_threshold_fp->hirssi_scan_delta = |
| roam_req->hi_rssi_scan_rssi_delta; |
| rssi_threshold_fp->hirssi_upper_bound = roam_req->hi_rssi_scan_rssi_ub; |
| rssi_threshold_fp->rssi_thresh_offset_5g = |
| roam_req->rssi_thresh_offset_5g; |
| |
| buf_ptr += sizeof(wmi_roam_scan_rssi_threshold_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_scan_extended_threshold_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| ext_thresholds = (wmi_roam_scan_extended_threshold_param *) buf_ptr; |
| |
| ext_thresholds->penalty_threshold_5g = roam_req->penalty_threshold_5g; |
| if (roam_req->raise_rssi_thresh_5g >= WMI_NOISE_FLOOR_DBM_DEFAULT) |
| ext_thresholds->boost_threshold_5g = |
| roam_req->boost_threshold_5g; |
| |
| ext_thresholds->boost_algorithm_5g = |
| WMI_ROAM_5G_BOOST_PENALIZE_ALGO_LINEAR; |
| ext_thresholds->boost_factor_5g = roam_req->raise_factor_5g; |
| ext_thresholds->penalty_algorithm_5g = |
| WMI_ROAM_5G_BOOST_PENALIZE_ALGO_LINEAR; |
| ext_thresholds->penalty_factor_5g = roam_req->drop_factor_5g; |
| ext_thresholds->max_boost_5g = roam_req->max_raise_rssi_5g; |
| ext_thresholds->max_penalty_5g = roam_req->max_drop_rssi_5g; |
| ext_thresholds->good_rssi_threshold = roam_req->good_rssi_threshold; |
| |
| WMITLV_SET_HDR(&ext_thresholds->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_scan_extended_threshold_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_scan_extended_threshold_param)); |
| buf_ptr += sizeof(wmi_roam_scan_extended_threshold_param); |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_earlystop_rssi_thres_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| early_stop_thresholds = (wmi_roam_earlystop_rssi_thres_param *) buf_ptr; |
| early_stop_thresholds->roam_earlystop_thres_min = |
| roam_req->roam_earlystop_thres_min; |
| early_stop_thresholds->roam_earlystop_thres_max = |
| roam_req->roam_earlystop_thres_max; |
| WMITLV_SET_HDR(&early_stop_thresholds->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_earlystop_rssi_thres_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_earlystop_rssi_thres_param)); |
| |
| buf_ptr += sizeof(wmi_roam_earlystop_rssi_thres_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_dense_thres_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| dense_thresholds = (wmi_roam_dense_thres_param *) buf_ptr; |
| dense_thresholds->roam_dense_rssi_thres_offset = |
| roam_req->dense_rssi_thresh_offset; |
| dense_thresholds->roam_dense_min_aps = roam_req->dense_min_aps_cnt; |
| dense_thresholds->roam_dense_traffic_thres = |
| roam_req->traffic_threshold; |
| dense_thresholds->roam_dense_status = roam_req->initial_dense_status; |
| WMITLV_SET_HDR(&dense_thresholds->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_dense_thres_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_dense_thres_param)); |
| |
| buf_ptr += sizeof(wmi_roam_dense_thres_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_roam_bg_scan_roaming_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| bg_scan_params = (wmi_roam_bg_scan_roaming_param *) buf_ptr; |
| bg_scan_params->roam_bg_scan_bad_rssi_thresh = |
| roam_req->bg_scan_bad_rssi_thresh; |
| bg_scan_params->roam_bg_scan_client_bitmap = |
| roam_req->bg_scan_client_bitmap; |
| bg_scan_params->bad_rssi_thresh_offset_2g = |
| roam_req->roam_bad_rssi_thresh_offset_2g; |
| bg_scan_params->flags = roam_req->flags; |
| WMITLV_SET_HDR(&bg_scan_params->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_bg_scan_roaming_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_bg_scan_roaming_param)); |
| |
| wmi_mtrace(WMI_ROAM_SCAN_RSSI_THRESHOLD, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_SCAN_RSSI_THRESHOLD); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd WMI_ROAM_SCAN_RSSI_THRESHOLD returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_adapt_dwelltime_params_cmd_tlv() - send wmi cmd of adaptive dwelltime |
| * configuration params |
| * @wma_handle: wma handler |
| * @dwelltime_params: pointer to dwelltime_params |
| * |
| * Return: QDF_STATUS_SUCCESS on success and QDF failure reason code for failure |
| */ |
| static |
| QDF_STATUS send_adapt_dwelltime_params_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_adaptive_dwelltime_params *dwelltime_params) |
| { |
| wmi_scan_adaptive_dwell_config_fixed_param *dwell_param; |
| wmi_scan_adaptive_dwell_parameters_tlv *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t err; |
| int len; |
| |
| len = sizeof(wmi_scan_adaptive_dwell_config_fixed_param); |
| len += WMI_TLV_HDR_SIZE; /* TLV for ext_thresholds*/ |
| len += sizeof(wmi_scan_adaptive_dwell_parameters_tlv); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s :Failed to allocate buffer to send cmd", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| dwell_param = (wmi_scan_adaptive_dwell_config_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&dwell_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_adaptive_dwell_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_scan_adaptive_dwell_config_fixed_param)); |
| |
| dwell_param->enable = dwelltime_params->is_enabled; |
| buf_ptr += sizeof(wmi_scan_adaptive_dwell_config_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_scan_adaptive_dwell_parameters_tlv)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| cmd = (wmi_scan_adaptive_dwell_parameters_tlv *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_adaptive_dwell_parameters_tlv, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_scan_adaptive_dwell_parameters_tlv)); |
| |
| cmd->default_adaptive_dwell_mode = dwelltime_params->dwelltime_mode; |
| cmd->adapative_lpf_weight = dwelltime_params->lpf_weight; |
| cmd->passive_monitor_interval_ms = dwelltime_params->passive_mon_intval; |
| cmd->wifi_activity_threshold_pct = dwelltime_params->wifi_act_threshold; |
| wmi_mtrace(WMI_SCAN_ADAPTIVE_DWELL_CONFIG_CMDID, NO_SESSION, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_SCAN_ADAPTIVE_DWELL_CONFIG_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send adapt dwelltime cmd err=%d", err); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_dbs_scan_sel_params_cmd_tlv() - send wmi cmd of DBS scan selection |
| * configuration params |
| * @wmi_handle: wmi handler |
| * @dbs_scan_params: pointer to wmi_dbs_scan_sel_params |
| * |
| * Return: QDF_STATUS_SUCCESS on success and QDF failure reason code for failure |
| */ |
| static QDF_STATUS send_dbs_scan_sel_params_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_dbs_scan_sel_params *dbs_scan_params) |
| { |
| wmi_scan_dbs_duty_cycle_fixed_param *dbs_scan_param; |
| wmi_scan_dbs_duty_cycle_tlv_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| QDF_STATUS err; |
| uint32_t i; |
| int len; |
| |
| len = sizeof(*dbs_scan_param); |
| len += WMI_TLV_HDR_SIZE; |
| len += dbs_scan_params->num_clients * sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:Failed to allocate buffer to send cmd", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| dbs_scan_param = (wmi_scan_dbs_duty_cycle_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&dbs_scan_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_dbs_duty_cycle_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_scan_dbs_duty_cycle_fixed_param)); |
| |
| dbs_scan_param->num_clients = dbs_scan_params->num_clients; |
| dbs_scan_param->pdev_id = dbs_scan_params->pdev_id; |
| buf_ptr += sizeof(*dbs_scan_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (sizeof(*cmd) * dbs_scan_params->num_clients)); |
| buf_ptr = buf_ptr + (uint8_t) WMI_TLV_HDR_SIZE; |
| |
| for (i = 0; i < dbs_scan_params->num_clients; i++) { |
| cmd = (wmi_scan_dbs_duty_cycle_tlv_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_scan_dbs_duty_cycle_param_tlv, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_scan_dbs_duty_cycle_tlv_param)); |
| cmd->module_id = dbs_scan_params->module_id[i]; |
| cmd->num_dbs_scans = dbs_scan_params->num_dbs_scans[i]; |
| cmd->num_non_dbs_scans = dbs_scan_params->num_non_dbs_scans[i]; |
| buf_ptr = buf_ptr + (uint8_t) sizeof(*cmd); |
| } |
| |
| wmi_mtrace(WMI_SET_SCAN_DBS_DUTY_CYCLE_CMDID, NO_SESSION, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_SET_SCAN_DBS_DUTY_CYCLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(err)) { |
| WMI_LOGE("Failed to send dbs scan selection cmd err=%d", err); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_roam_scan_filter_cmd_tlv() - Filter to be applied while roaming |
| * @wmi_handle: wmi handle |
| * @roam_req: Request which contains the filters |
| * |
| * There are filters such as whitelist, blacklist and preferred |
| * list that need to be applied to the scan results to form the |
| * probable candidates for roaming. |
| * |
| * Return: Return success upon successfully passing the |
| * parameters to the firmware, otherwise failure. |
| */ |
| static QDF_STATUS send_roam_scan_filter_cmd_tlv(wmi_unified_t wmi_handle, |
| struct roam_scan_filter_params *roam_req) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| uint32_t i; |
| uint32_t len, blist_len = 0; |
| uint8_t *buf_ptr; |
| wmi_roam_filter_fixed_param *roam_filter; |
| uint8_t *bssid_src_ptr = NULL; |
| wmi_mac_addr *bssid_dst_ptr = NULL; |
| wmi_ssid *ssid_ptr = NULL; |
| uint32_t *bssid_preferred_factor_ptr = NULL; |
| wmi_roam_lca_disallow_config_tlv_param *blist_param; |
| wmi_roam_rssi_rejection_oce_config_param *rssi_rej; |
| |
| len = sizeof(wmi_roam_filter_fixed_param); |
| |
| len += WMI_TLV_HDR_SIZE; |
| if (roam_req->num_bssid_black_list) |
| len += roam_req->num_bssid_black_list * sizeof(wmi_mac_addr); |
| len += WMI_TLV_HDR_SIZE; |
| if (roam_req->num_ssid_white_list) |
| len += roam_req->num_ssid_white_list * sizeof(wmi_ssid); |
| len += 2 * WMI_TLV_HDR_SIZE; |
| if (roam_req->num_bssid_preferred_list) { |
| len += roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr); |
| len += roam_req->num_bssid_preferred_list * sizeof(uint32_t); |
| } |
| len += WMI_TLV_HDR_SIZE; |
| if (roam_req->lca_disallow_config_present) { |
| len += sizeof(*blist_param); |
| blist_len = sizeof(*blist_param); |
| } |
| |
| len += WMI_TLV_HDR_SIZE; |
| if (roam_req->num_rssi_rejection_ap) |
| len += roam_req->num_rssi_rejection_ap * sizeof(*rssi_rej); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (u_int8_t *) wmi_buf_data(buf); |
| roam_filter = (wmi_roam_filter_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&roam_filter->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_filter_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_roam_filter_fixed_param)); |
| /* fill in fixed values */ |
| roam_filter->vdev_id = roam_req->session_id; |
| roam_filter->flags = 0; |
| roam_filter->op_bitmap = roam_req->op_bitmap; |
| roam_filter->num_bssid_black_list = roam_req->num_bssid_black_list; |
| roam_filter->num_ssid_white_list = roam_req->num_ssid_white_list; |
| roam_filter->num_bssid_preferred_list = |
| roam_req->num_bssid_preferred_list; |
| roam_filter->num_rssi_rejection_ap = |
| roam_req->num_rssi_rejection_ap; |
| buf_ptr += sizeof(wmi_roam_filter_fixed_param); |
| |
| WMITLV_SET_HDR((buf_ptr), |
| WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (roam_req->num_bssid_black_list * sizeof(wmi_mac_addr))); |
| bssid_src_ptr = (uint8_t *)&roam_req->bssid_avoid_list; |
| bssid_dst_ptr = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < roam_req->num_bssid_black_list; i++) { |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid_src_ptr, bssid_dst_ptr); |
| bssid_src_ptr += ATH_MAC_LEN; |
| bssid_dst_ptr++; |
| } |
| buf_ptr += WMI_TLV_HDR_SIZE + |
| (roam_req->num_bssid_black_list * sizeof(wmi_mac_addr)); |
| WMITLV_SET_HDR((buf_ptr), |
| WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (roam_req->num_ssid_white_list * sizeof(wmi_ssid))); |
| ssid_ptr = (wmi_ssid *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < roam_req->num_ssid_white_list; i++) { |
| qdf_mem_copy(&ssid_ptr->ssid, |
| &roam_req->ssid_allowed_list[i].mac_ssid, |
| roam_req->ssid_allowed_list[i].length); |
| ssid_ptr->ssid_len = roam_req->ssid_allowed_list[i].length; |
| ssid_ptr++; |
| } |
| buf_ptr += WMI_TLV_HDR_SIZE + (roam_req->num_ssid_white_list * |
| sizeof(wmi_ssid)); |
| WMITLV_SET_HDR((buf_ptr), |
| WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr))); |
| bssid_src_ptr = (uint8_t *)&roam_req->bssid_favored; |
| bssid_dst_ptr = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < roam_req->num_bssid_preferred_list; i++) { |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid_src_ptr, |
| (wmi_mac_addr *)bssid_dst_ptr); |
| bssid_src_ptr += ATH_MAC_LEN; |
| bssid_dst_ptr++; |
| } |
| buf_ptr += WMI_TLV_HDR_SIZE + |
| (roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr)); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (roam_req->num_bssid_preferred_list * sizeof(uint32_t))); |
| bssid_preferred_factor_ptr = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < roam_req->num_bssid_preferred_list; i++) { |
| *bssid_preferred_factor_ptr = |
| roam_req->bssid_favored_factor[i]; |
| bssid_preferred_factor_ptr++; |
| } |
| buf_ptr += WMI_TLV_HDR_SIZE + |
| (roam_req->num_bssid_preferred_list * sizeof(uint32_t)); |
| |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, blist_len); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| if (roam_req->lca_disallow_config_present) { |
| blist_param = |
| (wmi_roam_lca_disallow_config_tlv_param *) buf_ptr; |
| WMITLV_SET_HDR(&blist_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_lca_disallow_config_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_roam_lca_disallow_config_tlv_param)); |
| |
| blist_param->disallow_duration = roam_req->disallow_duration; |
| blist_param->rssi_channel_penalization = |
| roam_req->rssi_channel_penalization; |
| blist_param->num_disallowed_aps = roam_req->num_disallowed_aps; |
| blist_param->disallow_lca_enable_source_bitmap = |
| (WMI_ROAM_LCA_DISALLOW_SOURCE_PER | |
| WMI_ROAM_LCA_DISALLOW_SOURCE_BACKGROUND); |
| buf_ptr += (sizeof(wmi_roam_lca_disallow_config_tlv_param)); |
| } |
| |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| (roam_req->num_rssi_rejection_ap * sizeof(*rssi_rej))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = 0; i < roam_req->num_rssi_rejection_ap; i++) { |
| rssi_rej = |
| (wmi_roam_rssi_rejection_oce_config_param *) buf_ptr; |
| WMITLV_SET_HDR(&rssi_rej->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_rssi_rejection_oce_config_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_roam_rssi_rejection_oce_config_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR( |
| roam_req->rssi_rejection_ap[i].bssid.bytes, |
| &rssi_rej->bssid); |
| rssi_rej->remaining_disallow_duration = |
| roam_req->rssi_rejection_ap[i].remaining_duration; |
| rssi_rej->requested_rssi = |
| (int32_t)roam_req->rssi_rejection_ap[i].expected_rssi; |
| buf_ptr += |
| (sizeof(wmi_roam_rssi_rejection_oce_config_param)); |
| } |
| |
| wmi_mtrace(WMI_ROAM_FILTER_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_FILTER_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd WMI_ROAM_FILTER_CMDID returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| #if defined(WLAN_FEATURE_FILS_SK) |
| static QDF_STATUS send_roam_scan_send_hlp_cmd_tlv(wmi_unified_t wmi_handle, |
| struct hlp_params *params) |
| { |
| uint32_t len; |
| uint8_t *buf_ptr; |
| wmi_buf_t buf = NULL; |
| wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param *hlp_params; |
| |
| len = sizeof(wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param); |
| len += WMI_TLV_HDR_SIZE; |
| len += qdf_roundup(params->hlp_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_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| hlp_params = (wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&hlp_params->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param)); |
| |
| hlp_params->vdev_id = params->vdev_id; |
| hlp_params->size = params->hlp_ie_len; |
| hlp_params->pkt_type = WMI_FILS_HLP_PKT_TYPE_DHCP_DISCOVER; |
| |
| buf_ptr += sizeof(*hlp_params); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| round_up(params->hlp_ie_len, |
| sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, params->hlp_ie, params->hlp_ie_len); |
| |
| WMI_LOGD(FL("send FILS HLP pkt vdev %d len %d"), |
| hlp_params->vdev_id, hlp_params->size); |
| wmi_mtrace(WMI_PDEV_UPDATE_FILS_HLP_PKT_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_UPDATE_FILS_HLP_PKT_CMDID)) { |
| WMI_LOGE(FL("Failed to send FILS HLP pkt cmd")); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| #ifdef IPA_OFFLOAD |
| /** send_ipa_offload_control_cmd_tlv() - ipa offload control parameter |
| * @wmi_handle: wmi handle |
| * @ipa_offload: ipa offload control parameter |
| * |
| * Returns: 0 on success, error number otherwise |
| */ |
| static QDF_STATUS send_ipa_offload_control_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ipa_uc_offload_control_params *ipa_offload) |
| { |
| wmi_ipa_offload_enable_disable_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len; |
| u_int8_t *buf_ptr; |
| |
| len = sizeof(*cmd); |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed (len=%d)", __func__, len); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| WMI_LOGD("%s: offload_type=%d, enable=%d", __func__, |
| ipa_offload->offload_type, ipa_offload->enable); |
| |
| buf_ptr = (u_int8_t *)wmi_buf_data(wmi_buf); |
| |
| cmd = (wmi_ipa_offload_enable_disable_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUCT_wmi_ipa_offload_enable_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ipa_offload_enable_disable_cmd_fixed_param)); |
| |
| cmd->offload_type = ipa_offload->offload_type; |
| cmd->vdev_id = ipa_offload->vdev_id; |
| cmd->enable = ipa_offload->enable; |
| |
| wmi_mtrace(WMI_IPA_OFFLOAD_ENABLE_DISABLE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_IPA_OFFLOAD_ENABLE_DISABLE_CMDID)) { |
| WMI_LOGE("%s: failed to command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /** |
| * send_plm_stop_cmd_tlv() - plm stop request |
| * @wmi_handle: wmi handle |
| * @plm: plm request parameters |
| * |
| * This function request FW to stop PLM. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_plm_stop_cmd_tlv(wmi_unified_t wmi_handle, |
| const struct plm_req_params *plm) |
| { |
| wmi_vdev_plmreq_stop_cmd_fixed_param *cmd; |
| int32_t len; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_vdev_plmreq_stop_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_plmreq_stop_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_plmreq_stop_cmd_fixed_param)); |
| |
| cmd->vdev_id = plm->session_id; |
| |
| cmd->meas_token = plm->meas_token; |
| WMI_LOGD("vdev %d meas token %d", cmd->vdev_id, cmd->meas_token); |
| |
| wmi_mtrace(WMI_VDEV_PLMREQ_STOP_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_PLMREQ_STOP_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send plm stop wmi cmd", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_plm_start_cmd_tlv() - plm start request |
| * @wmi_handle: wmi handle |
| * @plm: plm request parameters |
| * |
| * This function request FW to start PLM. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_plm_start_cmd_tlv(wmi_unified_t wmi_handle, |
| const struct plm_req_params *plm, |
| uint32_t *gchannel_list) |
| { |
| wmi_vdev_plmreq_start_cmd_fixed_param *cmd; |
| uint32_t *channel_list; |
| int32_t len; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint8_t count; |
| int ret; |
| |
| /* TLV place holder for channel_list */ |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += sizeof(uint32_t) * plm->plm_num_ch; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_plmreq_start_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_plmreq_start_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_plmreq_start_cmd_fixed_param)); |
| |
| cmd->vdev_id = plm->session_id; |
| |
| cmd->meas_token = plm->meas_token; |
| cmd->dialog_token = plm->diag_token; |
| cmd->number_bursts = plm->num_bursts; |
| cmd->burst_interval = WMI_SEC_TO_MSEC(plm->burst_int); |
| cmd->off_duration = plm->meas_duration; |
| cmd->burst_cycle = plm->burst_len; |
| cmd->tx_power = plm->desired_tx_pwr; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(plm->mac_addr.bytes, &cmd->dest_mac); |
| cmd->num_chans = plm->plm_num_ch; |
| |
| buf_ptr += sizeof(wmi_vdev_plmreq_start_cmd_fixed_param); |
| |
| WMI_LOGD("vdev : %d measu token : %d", cmd->vdev_id, cmd->meas_token); |
| WMI_LOGD("dialog_token: %d", cmd->dialog_token); |
| WMI_LOGD("number_bursts: %d", cmd->number_bursts); |
| WMI_LOGD("burst_interval: %d", cmd->burst_interval); |
| WMI_LOGD("off_duration: %d", cmd->off_duration); |
| WMI_LOGD("burst_cycle: %d", cmd->burst_cycle); |
| WMI_LOGD("tx_power: %d", cmd->tx_power); |
| WMI_LOGD("Number of channels : %d", cmd->num_chans); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (cmd->num_chans * sizeof(uint32_t))); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| if (cmd->num_chans) { |
| channel_list = (uint32_t *) buf_ptr; |
| for (count = 0; count < cmd->num_chans; count++) { |
| channel_list[count] = plm->plm_ch_list[count]; |
| if (channel_list[count] < WMI_NLO_FREQ_THRESH) |
| channel_list[count] = |
| gchannel_list[count]; |
| WMI_LOGD("Ch[%d]: %d MHz", count, channel_list[count]); |
| } |
| buf_ptr += cmd->num_chans * sizeof(uint32_t); |
| } |
| |
| wmi_mtrace(WMI_VDEV_PLMREQ_START_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_PLMREQ_START_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send plm start wmi cmd", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_pno_stop_cmd_tlv() - PNO stop request |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * This function request FW to stop ongoing PNO operation. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_pno_stop_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id) |
| { |
| wmi_nlo_config_cmd_fixed_param *cmd; |
| int32_t len = sizeof(*cmd); |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int ret; |
| |
| /* |
| * TLV place holder for array of structures nlo_configured_parameters |
| * TLV place holder for array of uint32_t channel_list |
| * TLV place holder for chnl prediction cfg |
| */ |
| len += WMI_TLV_HDR_SIZE + WMI_TLV_HDR_SIZE + WMI_TLV_HDR_SIZE; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_nlo_config_cmd_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_nlo_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_nlo_config_cmd_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| cmd->flags = WMI_NLO_CONFIG_STOP; |
| buf_ptr += sizeof(*cmd); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| |
| wmi_mtrace(WMI_NETWORK_LIST_OFFLOAD_CONFIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_NETWORK_LIST_OFFLOAD_CONFIG_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send nlo wmi cmd", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * wmi_set_pno_channel_prediction() - Set PNO channel prediction |
| * @buf_ptr: Buffer passed by upper layers |
| * @pno: Buffer to be sent to the firmware |
| * |
| * Copy the PNO Channel prediction configuration parameters |
| * passed by the upper layers to a WMI format TLV and send it |
| * down to the firmware. |
| * |
| * Return: None |
| */ |
| static void wmi_set_pno_channel_prediction(uint8_t *buf_ptr, |
| struct pno_scan_req_params *pno) |
| { |
| nlo_channel_prediction_cfg *channel_prediction_cfg = |
| (nlo_channel_prediction_cfg *) buf_ptr; |
| WMITLV_SET_HDR(&channel_prediction_cfg->tlv_header, |
| WMITLV_TAG_ARRAY_BYTE, |
| WMITLV_GET_STRUCT_TLVLEN(nlo_channel_prediction_cfg)); |
| #ifdef FEATURE_WLAN_SCAN_PNO |
| channel_prediction_cfg->enable = pno->pno_channel_prediction; |
| channel_prediction_cfg->top_k_num = pno->top_k_num_of_channels; |
| channel_prediction_cfg->stationary_threshold = pno->stationary_thresh; |
| channel_prediction_cfg->full_scan_period_ms = |
| pno->channel_prediction_full_scan; |
| #endif |
| buf_ptr += sizeof(nlo_channel_prediction_cfg); |
| WMI_LOGD("enable: %d, top_k_num: %d, stat_thresh: %d, full_scan: %d", |
| channel_prediction_cfg->enable, |
| channel_prediction_cfg->top_k_num, |
| channel_prediction_cfg->stationary_threshold, |
| channel_prediction_cfg->full_scan_period_ms); |
| } |
| |
| /** |
| * send_nlo_mawc_cmd_tlv() - Send MAWC NLO configuration |
| * @wmi_handle: wmi handle |
| * @params: configuration parameters |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS send_nlo_mawc_cmd_tlv(wmi_unified_t wmi_handle, |
| struct nlo_mawc_params *params) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_nlo_configure_mawc_cmd_fixed_param *wmi_nlo_mawc_params; |
| |
| len = sizeof(*wmi_nlo_mawc_params); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| wmi_nlo_mawc_params = |
| (wmi_nlo_configure_mawc_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&wmi_nlo_mawc_params->tlv_header, |
| WMITLV_TAG_STRUC_wmi_nlo_configure_mawc_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_nlo_configure_mawc_cmd_fixed_param)); |
| wmi_nlo_mawc_params->vdev_id = params->vdev_id; |
| if (params->enable) |
| wmi_nlo_mawc_params->enable = 1; |
| else |
| wmi_nlo_mawc_params->enable = 0; |
| wmi_nlo_mawc_params->exp_backoff_ratio = params->exp_backoff_ratio; |
| wmi_nlo_mawc_params->init_scan_interval = params->init_scan_interval; |
| wmi_nlo_mawc_params->max_scan_interval = params->max_scan_interval; |
| WMI_LOGD(FL("MAWC NLO en=%d, vdev=%d, ratio=%d, SCAN init=%d, max=%d"), |
| wmi_nlo_mawc_params->enable, wmi_nlo_mawc_params->vdev_id, |
| wmi_nlo_mawc_params->exp_backoff_ratio, |
| wmi_nlo_mawc_params->init_scan_interval, |
| wmi_nlo_mawc_params->max_scan_interval); |
| |
| wmi_mtrace(WMI_NLO_CONFIGURE_MAWC_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_NLO_CONFIGURE_MAWC_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_NLO_CONFIGURE_MAWC_CMDID failed, Error %d", |
| status); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_pno_start_cmd_tlv() - PNO start request |
| * @wmi_handle: wmi handle |
| * @pno: PNO request |
| * |
| * This function request FW to start PNO request. |
| * Request: CDF status |
| */ |
| static QDF_STATUS send_pno_start_cmd_tlv(wmi_unified_t wmi_handle, |
| struct pno_scan_req_params *pno) |
| { |
| wmi_nlo_config_cmd_fixed_param *cmd; |
| nlo_configured_parameters *nlo_list; |
| uint32_t *channel_list; |
| int32_t len; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint8_t i; |
| int ret; |
| struct probe_req_whitelist_attr *ie_whitelist = &pno->ie_whitelist; |
| connected_nlo_rssi_params *nlo_relative_rssi; |
| connected_nlo_bss_band_rssi_pref *nlo_band_rssi; |
| |
| /* |
| * TLV place holder for array nlo_configured_parameters(nlo_list) |
| * TLV place holder for array of uint32_t channel_list |
| * TLV place holder for chnnl prediction cfg |
| * TLV place holder for array of wmi_vendor_oui |
| * TLV place holder for array of connected_nlo_bss_band_rssi_pref |
| */ |
| len = sizeof(*cmd) + |
| WMI_TLV_HDR_SIZE + WMI_TLV_HDR_SIZE + WMI_TLV_HDR_SIZE + |
| WMI_TLV_HDR_SIZE + WMI_TLV_HDR_SIZE; |
| |
| len += sizeof(uint32_t) * QDF_MIN(pno->networks_list[0].channel_cnt, |
| WMI_NLO_MAX_CHAN); |
| len += sizeof(nlo_configured_parameters) * |
| QDF_MIN(pno->networks_cnt, WMI_NLO_MAX_SSIDS); |
| len += sizeof(nlo_channel_prediction_cfg); |
| len += sizeof(enlo_candidate_score_params); |
| len += sizeof(wmi_vendor_oui) * ie_whitelist->num_vendor_oui; |
| len += sizeof(connected_nlo_rssi_params); |
| len += sizeof(connected_nlo_bss_band_rssi_pref); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_nlo_config_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| buf_ptr = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_nlo_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_nlo_config_cmd_fixed_param)); |
| cmd->vdev_id = pno->vdev_id; |
| cmd->flags = WMI_NLO_CONFIG_START | WMI_NLO_CONFIG_SSID_HIDE_EN; |
| |
| #ifdef FEATURE_WLAN_SCAN_PNO |
| WMI_SCAN_SET_DWELL_MODE(cmd->flags, |
| pno->adaptive_dwell_mode); |
| #endif |
| /* Current FW does not support min-max range for dwell time */ |
| cmd->active_dwell_time = pno->active_dwell_time; |
| cmd->passive_dwell_time = pno->passive_dwell_time; |
| |
| if (pno->do_passive_scan) |
| cmd->flags |= WMI_NLO_CONFIG_SCAN_PASSIVE; |
| /* Copy scan interval */ |
| cmd->fast_scan_period = pno->fast_scan_period; |
| cmd->slow_scan_period = pno->slow_scan_period; |
| cmd->delay_start_time = WMI_SEC_TO_MSEC(pno->delay_start_time); |
| cmd->fast_scan_max_cycles = pno->fast_scan_max_cycles; |
| cmd->scan_backoff_multiplier = pno->scan_backoff_multiplier; |
| WMI_LOGD("fast_scan_period: %d msec slow_scan_period: %d msec", |
| cmd->fast_scan_period, cmd->slow_scan_period); |
| WMI_LOGD("fast_scan_max_cycles: %d", cmd->fast_scan_max_cycles); |
| |
| /* mac randomization attributes */ |
| if (pno->scan_random.randomize) { |
| cmd->flags |= WMI_NLO_CONFIG_SPOOFED_MAC_IN_PROBE_REQ | |
| WMI_NLO_CONFIG_RANDOM_SEQ_NO_IN_PROBE_REQ; |
| wmi_copy_scan_random_mac(pno->scan_random.mac_addr, |
| pno->scan_random.mac_mask, |
| &cmd->mac_addr, |
| &cmd->mac_mask); |
| } |
| |
| buf_ptr += sizeof(wmi_nlo_config_cmd_fixed_param); |
| |
| cmd->no_of_ssids = QDF_MIN(pno->networks_cnt, WMI_NLO_MAX_SSIDS); |
| WMI_LOGD("SSID count : %d", cmd->no_of_ssids); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| cmd->no_of_ssids * sizeof(nlo_configured_parameters)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| nlo_list = (nlo_configured_parameters *) buf_ptr; |
| for (i = 0; i < cmd->no_of_ssids; i++) { |
| WMITLV_SET_HDR(&nlo_list[i].tlv_header, |
| WMITLV_TAG_ARRAY_BYTE, |
| WMITLV_GET_STRUCT_TLVLEN |
| (nlo_configured_parameters)); |
| /* Copy ssid and it's length */ |
| nlo_list[i].ssid.valid = true; |
| nlo_list[i].ssid.ssid.ssid_len = |
| pno->networks_list[i].ssid.length; |
| qdf_mem_copy(nlo_list[i].ssid.ssid.ssid, |
| pno->networks_list[i].ssid.ssid, |
| nlo_list[i].ssid.ssid.ssid_len); |
| WMI_LOGD("index: %d ssid: %.*s len: %d", i, |
| nlo_list[i].ssid.ssid.ssid_len, |
| (char *)nlo_list[i].ssid.ssid.ssid, |
| nlo_list[i].ssid.ssid.ssid_len); |
| |
| /* Copy rssi threshold */ |
| if (pno->networks_list[i].rssi_thresh && |
| pno->networks_list[i].rssi_thresh > |
| WMI_RSSI_THOLD_DEFAULT) { |
| nlo_list[i].rssi_cond.valid = true; |
| nlo_list[i].rssi_cond.rssi = |
| pno->networks_list[i].rssi_thresh; |
| WMI_LOGD("RSSI threshold : %d dBm", |
| nlo_list[i].rssi_cond.rssi); |
| } |
| nlo_list[i].bcast_nw_type.valid = true; |
| nlo_list[i].bcast_nw_type.bcast_nw_type = |
| pno->networks_list[i].bc_new_type; |
| WMI_LOGD("Broadcast NW type (%u)", |
| nlo_list[i].bcast_nw_type.bcast_nw_type); |
| } |
| buf_ptr += cmd->no_of_ssids * sizeof(nlo_configured_parameters); |
| |
| /* Copy channel info */ |
| cmd->num_of_channels = QDF_MIN(pno->networks_list[0].channel_cnt, |
| WMI_NLO_MAX_CHAN); |
| WMI_LOGD("Channel count: %d", cmd->num_of_channels); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (cmd->num_of_channels * sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| channel_list = (uint32_t *) buf_ptr; |
| for (i = 0; i < cmd->num_of_channels; i++) { |
| channel_list[i] = pno->networks_list[0].channels[i]; |
| |
| if (channel_list[i] < WMI_NLO_FREQ_THRESH) |
| channel_list[i] = |
| wlan_chan_to_freq(pno-> |
| networks_list[0].channels[i]); |
| |
| WMI_LOGD("Ch[%d]: %d MHz", i, channel_list[i]); |
| } |
| buf_ptr += cmd->num_of_channels * sizeof(uint32_t); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(nlo_channel_prediction_cfg)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| wmi_set_pno_channel_prediction(buf_ptr, pno); |
| buf_ptr += sizeof(nlo_channel_prediction_cfg); |
| /** TODO: Discrete firmware doesn't have command/option to configure |
| * App IE which comes from wpa_supplicant as of part PNO start request. |
| */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_STRUC_enlo_candidate_score_param, |
| WMITLV_GET_STRUCT_TLVLEN(enlo_candidate_score_params)); |
| buf_ptr += sizeof(enlo_candidate_score_params); |
| |
| if (ie_whitelist->white_list) { |
| cmd->flags |= WMI_NLO_CONFIG_ENABLE_IE_WHITELIST_IN_PROBE_REQ; |
| wmi_fill_ie_whitelist_attrs(cmd->ie_bitmap, |
| &cmd->num_vendor_oui, |
| ie_whitelist); |
| } |
| |
| /* ie white list */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| ie_whitelist->num_vendor_oui * sizeof(wmi_vendor_oui)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| if (cmd->num_vendor_oui != 0) { |
| wmi_fill_vendor_oui(buf_ptr, cmd->num_vendor_oui, |
| ie_whitelist->voui); |
| buf_ptr += cmd->num_vendor_oui * sizeof(wmi_vendor_oui); |
| } |
| |
| if (pno->relative_rssi_set) |
| cmd->flags |= WMI_NLO_CONFIG_ENABLE_CNLO_RSSI_CONFIG; |
| |
| /* |
| * Firmware calculation using connected PNO params: |
| * New AP's RSSI >= (Connected AP's RSSI + relative_rssi +/- rssi_pref) |
| * deduction of rssi_pref for chosen band_pref and |
| * addition of rssi_pref for remaining bands (other than chosen band). |
| */ |
| nlo_relative_rssi = (connected_nlo_rssi_params *) buf_ptr; |
| WMITLV_SET_HDR(&nlo_relative_rssi->tlv_header, |
| WMITLV_TAG_STRUC_wmi_connected_nlo_rssi_params, |
| WMITLV_GET_STRUCT_TLVLEN(connected_nlo_rssi_params)); |
| nlo_relative_rssi->relative_rssi = pno->relative_rssi; |
| WMI_LOGD("relative_rssi %d", nlo_relative_rssi->relative_rssi); |
| buf_ptr += sizeof(*nlo_relative_rssi); |
| |
| /* |
| * As of now Kernel and Host supports one band and rssi preference. |
| * Firmware supports array of band and rssi preferences |
| */ |
| cmd->num_cnlo_band_pref = 1; |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| cmd->num_cnlo_band_pref * |
| sizeof(connected_nlo_bss_band_rssi_pref)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| nlo_band_rssi = (connected_nlo_bss_band_rssi_pref *) buf_ptr; |
| for (i = 0; i < cmd->num_cnlo_band_pref; i++) { |
| WMITLV_SET_HDR(&nlo_band_rssi[i].tlv_header, |
| WMITLV_TAG_STRUC_wmi_connected_nlo_bss_band_rssi_pref, |
| WMITLV_GET_STRUCT_TLVLEN( |
| connected_nlo_bss_band_rssi_pref)); |
| nlo_band_rssi[i].band = pno->band_rssi_pref.band; |
| nlo_band_rssi[i].rssi_pref = pno->band_rssi_pref.rssi; |
| WMI_LOGI("band_pref %d, rssi_pref %d", |
| nlo_band_rssi[i].band, |
| nlo_band_rssi[i].rssi_pref); |
| } |
| buf_ptr += cmd->num_cnlo_band_pref * sizeof(*nlo_band_rssi); |
| |
| wmi_mtrace(WMI_NETWORK_LIST_OFFLOAD_CONFIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_NETWORK_LIST_OFFLOAD_CONFIG_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send nlo wmi cmd", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef WLAN_FEATURE_ROAM_OFFLOAD |
| /* send_set_ric_req_cmd_tlv() - set ric request element |
| * @wmi_handle: wmi handle |
| * @msg: message |
| * @is_add_ts: is addts required |
| * |
| * This function sets ric request element for 11r roaming. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_ric_req_cmd_tlv(wmi_unified_t wmi_handle, |
| void *msg, uint8_t is_add_ts) |
| { |
| wmi_ric_request_fixed_param *cmd; |
| wmi_ric_tspec *tspec_param; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| struct mac_tspec_ie *ptspecIE = NULL; |
| int32_t len = sizeof(wmi_ric_request_fixed_param) + |
| WMI_TLV_HDR_SIZE + sizeof(wmi_ric_tspec); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| |
| cmd = (wmi_ric_request_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ric_request_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ric_request_fixed_param)); |
| if (is_add_ts) |
| cmd->vdev_id = ((struct add_ts_param *) msg)->sme_session_id; |
| else |
| cmd->vdev_id = ((struct del_ts_params *) msg)->sessionId; |
| cmd->num_ric_request = 1; |
| cmd->is_add_ric = is_add_ts; |
| |
| buf_ptr += sizeof(wmi_ric_request_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, sizeof(wmi_ric_tspec)); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| tspec_param = (wmi_ric_tspec *) buf_ptr; |
| WMITLV_SET_HDR(&tspec_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ric_tspec, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ric_tspec)); |
| |
| if (is_add_ts) |
| ptspecIE = &(((struct add_ts_param *) msg)->tspec); |
| else |
| ptspecIE = &(((struct del_ts_params *) msg)->delTsInfo.tspec); |
| if (ptspecIE) { |
| /* Fill the tsinfo in the format expected by firmware */ |
| #ifndef ANI_LITTLE_BIT_ENDIAN |
| qdf_mem_copy(((uint8_t *) &tspec_param->ts_info) + 1, |
| ((uint8_t *) &ptspecIE->tsinfo) + 1, 2); |
| #else |
| qdf_mem_copy(((uint8_t *) &tspec_param->ts_info), |
| ((uint8_t *) &ptspecIE->tsinfo) + 1, 2); |
| #endif /* ANI_LITTLE_BIT_ENDIAN */ |
| |
| tspec_param->nominal_msdu_size = ptspecIE->nomMsduSz; |
| tspec_param->maximum_msdu_size = ptspecIE->maxMsduSz; |
| tspec_param->min_service_interval = ptspecIE->minSvcInterval; |
| tspec_param->max_service_interval = ptspecIE->maxSvcInterval; |
| tspec_param->inactivity_interval = ptspecIE->inactInterval; |
| tspec_param->suspension_interval = ptspecIE->suspendInterval; |
| tspec_param->svc_start_time = ptspecIE->svcStartTime; |
| tspec_param->min_data_rate = ptspecIE->minDataRate; |
| tspec_param->mean_data_rate = ptspecIE->meanDataRate; |
| tspec_param->peak_data_rate = ptspecIE->peakDataRate; |
| tspec_param->max_burst_size = ptspecIE->maxBurstSz; |
| tspec_param->delay_bound = ptspecIE->delayBound; |
| tspec_param->min_phy_rate = ptspecIE->minPhyRate; |
| tspec_param->surplus_bw_allowance = ptspecIE->surplusBw; |
| tspec_param->medium_time = 0; |
| } |
| WMI_LOGI("%s: Set RIC Req is_add_ts:%d", __func__, is_add_ts); |
| |
| wmi_mtrace(WMI_ROAM_SET_RIC_REQUEST_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_ROAM_SET_RIC_REQUEST_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev Set RIC Req command", |
| __func__); |
| if (is_add_ts) |
| ((struct add_ts_param *) msg)->status = |
| QDF_STATUS_E_FAILURE; |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_process_roam_synch_complete_cmd_tlv() - roam synch complete command to fw. |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * This function sends roam synch complete event to fw. |
| * |
| * Return: CDF STATUS |
| */ |
| static QDF_STATUS send_process_roam_synch_complete_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id) |
| { |
| wmi_roam_synch_complete_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint8_t *buf_ptr; |
| uint16_t len; |
| len = sizeof(wmi_roam_synch_complete_fixed_param); |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_roam_synch_complete_fixed_param *) wmi_buf_data(wmi_buf); |
| buf_ptr = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_synch_complete_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_synch_complete_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| wmi_mtrace(WMI_ROAM_SYNCH_COMPLETE, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_ROAM_SYNCH_COMPLETE)) { |
| WMI_LOGP("%s: failed to send roam synch confirmation", |
| __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| #ifdef WLAN_FEATURE_LINK_LAYER_STATS |
| /** |
| * send_process_ll_stats_clear_cmd_tlv() - clear link layer stats |
| * @wmi_handle: wmi handle |
| * @clear_req: ll stats clear request command params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_process_ll_stats_clear_cmd_tlv(wmi_unified_t wmi_handle, |
| const struct ll_stats_clear_params *clear_req, |
| uint8_t addr[IEEE80211_ADDR_LEN]) |
| { |
| wmi_clear_link_stats_cmd_fixed_param *cmd; |
| int32_t len; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_clear_link_stats_cmd_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_clear_link_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_clear_link_stats_cmd_fixed_param)); |
| |
| cmd->stop_stats_collection_req = clear_req->stop_req; |
| cmd->vdev_id = clear_req->sta_id; |
| cmd->stats_clear_req_mask = clear_req->stats_clear_mask; |
| |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(addr, |
| &cmd->peer_macaddr); |
| |
| WMI_LOGD("LINK_LAYER_STATS - Clear Request Params"); |
| WMI_LOGD("StopReq : %d", cmd->stop_stats_collection_req); |
| WMI_LOGD("Vdev Id : %d", cmd->vdev_id); |
| WMI_LOGD("Clear Stat Mask : %d", cmd->stats_clear_req_mask); |
| /* WMI_LOGD("Peer MAC Addr : %pM", |
| cmd->peer_macaddr); */ |
| |
| wmi_mtrace(WMI_CLEAR_LINK_STATS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_CLEAR_LINK_STATS_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send clear link stats req", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| WMI_LOGD("Clear Link Layer Stats request sent successfully"); |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_process_ll_stats_set_cmd_tlv() - link layer stats set request |
| * @wmi_handle: wmi handle |
| * @setReq: ll stats set request command params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_process_ll_stats_set_cmd_tlv(wmi_unified_t wmi_handle, |
| const struct ll_stats_set_params *set_req) |
| { |
| wmi_start_link_stats_cmd_fixed_param *cmd; |
| int32_t len; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_start_link_stats_cmd_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_start_link_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_start_link_stats_cmd_fixed_param)); |
| |
| cmd->mpdu_size_threshold = set_req->mpdu_size_threshold; |
| cmd->aggressive_statistics_gathering = |
| set_req->aggressive_statistics_gathering; |
| |
| WMI_LOGD("LINK_LAYER_STATS - Start/Set Request Params"); |
| WMI_LOGD("MPDU Size Thresh : %d", cmd->mpdu_size_threshold); |
| WMI_LOGD("Aggressive Gather: %d", cmd->aggressive_statistics_gathering); |
| |
| wmi_mtrace(WMI_START_LINK_STATS_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_START_LINK_STATS_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send set link stats request", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_process_ll_stats_get_cmd_tlv() - link layer stats get request |
| * @wmi_handle:wmi handle |
| * @get_req:ll stats get request command params |
| * @addr: mac address |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_process_ll_stats_get_cmd_tlv(wmi_unified_t wmi_handle, |
| const struct ll_stats_get_params *get_req, |
| uint8_t addr[IEEE80211_ADDR_LEN]) |
| { |
| wmi_request_link_stats_cmd_fixed_param *cmd; |
| int32_t len; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s: buf allocation failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_request_link_stats_cmd_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_link_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_link_stats_cmd_fixed_param)); |
| |
| cmd->request_id = get_req->req_id; |
| cmd->stats_type = get_req->param_id_mask; |
| cmd->vdev_id = get_req->sta_id; |
| |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(addr, |
| &cmd->peer_macaddr); |
| |
| WMI_LOGD("LINK_LAYER_STATS - Get Request Params"); |
| WMI_LOGD("Request ID : %u", cmd->request_id); |
| WMI_LOGD("Stats Type : %0x", cmd->stats_type); |
| WMI_LOGD("Vdev ID : %d", cmd->vdev_id); |
| WMI_LOGD("Peer MAC Addr : %pM", addr); |
| |
| wmi_mtrace(WMI_REQUEST_LINK_STATS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_LINK_STATS_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send get link stats request", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif /* WLAN_FEATURE_LINK_LAYER_STATS */ |
| |
| /** |
| * send_congestion_cmd_tlv() - send request to fw to get CCA |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_congestion_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id) |
| { |
| wmi_buf_t buf; |
| wmi_request_stats_cmd_fixed_param *cmd; |
| uint8_t len; |
| uint8_t *buf_ptr; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed to allocate wmi buffer", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| cmd = (wmi_request_stats_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_stats_cmd_fixed_param)); |
| |
| cmd->stats_id = WMI_REQUEST_CONGESTION_STAT; |
| cmd->vdev_id = vdev_id; |
| WMI_LOGD("STATS REQ VDEV_ID:%d stats_id %d -->", |
| cmd->vdev_id, cmd->stats_id); |
| |
| wmi_mtrace(WMI_REQUEST_STATS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_STATS_CMDID)) { |
| WMI_LOGE("%s: Failed to send WMI_REQUEST_STATS_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_snr_request_cmd_tlv() - send request to fw to get RSSI stats |
| * @wmi_handle: wmi handle |
| * @rssi_req: get RSSI request |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_snr_request_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_buf_t buf; |
| wmi_request_stats_cmd_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_request_stats_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_request_stats_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_stats_cmd_fixed_param)); |
| cmd->stats_id = WMI_REQUEST_VDEV_STAT; |
| wmi_mtrace(WMI_REQUEST_STATS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send |
| (wmi_handle, buf, len, WMI_REQUEST_STATS_CMDID)) { |
| WMI_LOGE("Failed to send host stats request to fw"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_snr_cmd_tlv() - get RSSI from fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_snr_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id) |
| { |
| wmi_buf_t buf; |
| wmi_request_stats_cmd_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_request_stats_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_request_stats_cmd_fixed_param *) wmi_buf_data(buf); |
| cmd->vdev_id = vdev_id; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_stats_cmd_fixed_param)); |
| cmd->stats_id = WMI_REQUEST_VDEV_STAT; |
| wmi_mtrace(WMI_REQUEST_STATS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_STATS_CMDID)) { |
| WMI_LOGE("Failed to send host stats request to fw"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_link_status_req_cmd_tlv() - process link status request from UMAC |
| * @wmi_handle: wmi handle |
| * @link_status: get link params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_link_status_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct link_status_params *link_status) |
| { |
| wmi_buf_t buf; |
| wmi_request_stats_cmd_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_request_stats_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_request_stats_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_stats_cmd_fixed_param)); |
| cmd->stats_id = WMI_REQUEST_VDEV_RATE_STAT; |
| cmd->vdev_id = link_status->session_id; |
| wmi_mtrace(WMI_REQUEST_STATS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_STATS_CMDID)) { |
| WMI_LOGE("Failed to send WMI link status request to fw"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_process_dhcp_ind_cmd_tlv() - process dhcp indication from SME |
| * @wmi_handle: wmi handle |
| * @ta_dhcp_ind: DHCP indication parameter |
| * |
| * Return: CDF Status |
| */ |
| static QDF_STATUS send_process_dhcp_ind_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_peer_set_param_cmd_fixed_param *ta_dhcp_ind) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_peer_set_param_cmd_fixed_param *peer_set_param_fp; |
| int len = sizeof(wmi_peer_set_param_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| peer_set_param_fp = (wmi_peer_set_param_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&peer_set_param_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_set_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_set_param_cmd_fixed_param)); |
| |
| /* fill in values */ |
| peer_set_param_fp->vdev_id = ta_dhcp_ind->vdev_id; |
| peer_set_param_fp->param_id = ta_dhcp_ind->param_id; |
| peer_set_param_fp->param_value = ta_dhcp_ind->param_value; |
| qdf_mem_copy(&peer_set_param_fp->peer_macaddr, |
| &ta_dhcp_ind->peer_macaddr, |
| sizeof(ta_dhcp_ind->peer_macaddr)); |
| |
| wmi_mtrace(WMI_PEER_SET_PARAM_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_PEER_SET_PARAM_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("%s: wmi_unified_cmd_send WMI_PEER_SET_PARAM_CMD" |
| " returned Error %d", __func__, status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_get_link_speed_cmd_tlv() -send command to get linkspeed |
| * @wmi_handle: wmi handle |
| * @pLinkSpeed: link speed info |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_get_link_speed_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_mac_addr peer_macaddr) |
| { |
| wmi_peer_get_estimated_linkspeed_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len; |
| uint8_t *buf_ptr; |
| |
| len = sizeof(wmi_peer_get_estimated_linkspeed_cmd_fixed_param); |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| |
| cmd = (wmi_peer_get_estimated_linkspeed_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_get_estimated_linkspeed_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_peer_get_estimated_linkspeed_cmd_fixed_param)); |
| |
| /* Copy the peer macaddress to the wma buffer */ |
| qdf_mem_copy(&cmd->peer_macaddr, |
| &peer_macaddr, |
| sizeof(peer_macaddr)); |
| |
| |
| wmi_mtrace(WMI_PEER_GET_ESTIMATED_LINKSPEED_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_PEER_GET_ESTIMATED_LINKSPEED_CMDID)) { |
| WMI_LOGE("%s: failed to send link speed command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef WLAN_SUPPORT_GREEN_AP |
| /** |
| * send_egap_conf_params_cmd_tlv() - send wmi cmd of egap configuration params |
| * @wmi_handle: wmi handler |
| * @egap_params: pointer to egap_params |
| * |
| * Return: 0 for success, otherwise appropriate error code |
| */ |
| static QDF_STATUS send_egap_conf_params_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wlan_green_ap_egap_params *egap_params) |
| { |
| wmi_ap_ps_egap_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t err; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send ap_ps_egap cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_ap_ps_egap_param_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ap_ps_egap_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ap_ps_egap_param_cmd_fixed_param)); |
| |
| cmd->enable = egap_params->host_enable_egap; |
| cmd->inactivity_time = egap_params->egap_inactivity_time; |
| cmd->wait_time = egap_params->egap_wait_time; |
| cmd->flags = egap_params->egap_feature_flags; |
| wmi_mtrace(WMI_AP_PS_EGAP_PARAM_CMDID, NO_SESSION, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), WMI_AP_PS_EGAP_PARAM_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send ap_ps_egap cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /** |
| * send_fw_profiling_cmd_tlv() - send FW profiling cmd to WLAN FW |
| * @wmi_handl: wmi handle |
| * @cmd: Profiling command index |
| * @value1: parameter1 value |
| * @value2: parameter2 value |
| * |
| * Return: QDF_STATUS_SUCCESS for success else error code |
| */ |
| static QDF_STATUS send_fw_profiling_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t cmd, uint32_t value1, uint32_t value2) |
| { |
| wmi_buf_t buf; |
| int32_t len = 0; |
| int ret; |
| wmi_wlan_profile_trigger_cmd_fixed_param *prof_trig_cmd; |
| wmi_wlan_profile_set_hist_intvl_cmd_fixed_param *hist_intvl_cmd; |
| wmi_wlan_profile_enable_profile_id_cmd_fixed_param *profile_enable_cmd; |
| wmi_wlan_profile_get_prof_data_cmd_fixed_param *profile_getdata_cmd; |
| |
| switch (cmd) { |
| case WMI_WLAN_PROFILE_TRIGGER_CMDID: |
| len = sizeof(wmi_wlan_profile_trigger_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| prof_trig_cmd = |
| (wmi_wlan_profile_trigger_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&prof_trig_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wlan_profile_trigger_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wlan_profile_trigger_cmd_fixed_param)); |
| prof_trig_cmd->enable = value1; |
| wmi_mtrace(WMI_WLAN_PROFILE_TRIGGER_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WLAN_PROFILE_TRIGGER_CMDID); |
| if (ret) { |
| WMI_LOGE("PROFILE_TRIGGER cmd Failed with value %d", |
| value1); |
| wmi_buf_free(buf); |
| return ret; |
| } |
| break; |
| |
| case WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID: |
| len = sizeof(wmi_wlan_profile_get_prof_data_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| profile_getdata_cmd = |
| (wmi_wlan_profile_get_prof_data_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&profile_getdata_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wlan_profile_get_prof_data_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wlan_profile_get_prof_data_cmd_fixed_param)); |
| wmi_mtrace(WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID, |
| NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID); |
| if (ret) { |
| WMI_LOGE("PROFILE_DATA cmd Failed for id %d value %d", |
| value1, value2); |
| wmi_buf_free(buf); |
| return ret; |
| } |
| break; |
| |
| case WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID: |
| len = sizeof(wmi_wlan_profile_set_hist_intvl_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| hist_intvl_cmd = |
| (wmi_wlan_profile_set_hist_intvl_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&hist_intvl_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wlan_profile_set_hist_intvl_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wlan_profile_set_hist_intvl_cmd_fixed_param)); |
| hist_intvl_cmd->profile_id = value1; |
| hist_intvl_cmd->value = value2; |
| wmi_mtrace(WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID, |
| NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID); |
| if (ret) { |
| WMI_LOGE("HIST_INTVL cmd Failed for id %d value %d", |
| value1, value2); |
| wmi_buf_free(buf); |
| return ret; |
| } |
| break; |
| |
| case WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID: |
| len = |
| sizeof(wmi_wlan_profile_enable_profile_id_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc Failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| profile_enable_cmd = |
| (wmi_wlan_profile_enable_profile_id_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&profile_enable_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wlan_profile_enable_profile_id_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wlan_profile_enable_profile_id_cmd_fixed_param)); |
| profile_enable_cmd->profile_id = value1; |
| profile_enable_cmd->enable = value2; |
| wmi_mtrace(WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID, |
| NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID); |
| if (ret) { |
| WMI_LOGE("enable cmd Failed for id %d value %d", |
| value1, value2); |
| wmi_buf_free(buf); |
| return ret; |
| } |
| break; |
| |
| default: |
| WMI_LOGD("%s: invalid profiling command", __func__); |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static QDF_STATUS send_wlm_latency_level_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wlm_latency_level_param *params) |
| { |
| wmi_wlm_config_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint32_t len = sizeof(*cmd); |
| static uint32_t ll[4] = {100, 60, 40, 20}; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_wlm_config_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wlm_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wlm_config_cmd_fixed_param)); |
| cmd->vdev_id = params->vdev_id; |
| cmd->latency_level = params->wlm_latency_level; |
| cmd->ul_latency = ll[params->wlm_latency_level]; |
| cmd->dl_latency = ll[params->wlm_latency_level]; |
| cmd->flags = params->wlm_latency_flags; |
| wmi_mtrace(WMI_WLM_CONFIG_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WLM_CONFIG_CMDID)) { |
| WMI_LOGE("%s: Failed to send setting latency config command", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| /** |
| * send_nat_keepalive_en_cmd_tlv() - enable NAT keepalive filter |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_nat_keepalive_en_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id) |
| { |
| WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| WMI_LOGD("%s: vdev_id %d", __func__, vdev_id); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMD_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->action = IPSEC_NATKEEPALIVE_FILTER_ENABLE; |
| wmi_mtrace(WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_IPSEC_NATKEEPALIVE_FILTER_CMDID)) { |
| WMI_LOGP("%s: Failed to send NAT keepalive enable command", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * wmi_unified_csa_offload_enable() - sen CSA offload enable command |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_csa_offload_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id) |
| { |
| wmi_csa_offload_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| WMI_LOGD("%s: vdev_id %d", __func__, vdev_id); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_csa_offload_enable_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_csa_offload_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_csa_offload_enable_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->csa_offload_enable = WMI_CSA_OFFLOAD_ENABLE; |
| wmi_mtrace(WMI_CSA_OFFLOAD_ENABLE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_CSA_OFFLOAD_ENABLE_CMDID)) { |
| WMI_LOGP("%s: Failed to send CSA offload enable command", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| #ifdef WLAN_FEATURE_CIF_CFR |
| /** |
| * send_oem_dma_cfg_cmd_tlv() - configure OEM DMA rings |
| * @wmi_handle: wmi handle |
| * @data_len: len of dma cfg req |
| * @data: dma cfg req |
| * |
| * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_FAILURE for failure |
| */ |
| static QDF_STATUS send_oem_dma_cfg_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_oem_dma_ring_cfg_req_fixed_param *cfg) |
| { |
| wmi_buf_t buf; |
| uint8_t *cmd; |
| QDF_STATUS ret; |
| |
| WMITLV_SET_HDR(cfg, |
| WMITLV_TAG_STRUC_wmi_oem_dma_ring_cfg_req_fixed_param, |
| (sizeof(*cfg) - WMI_TLV_HDR_SIZE)); |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cfg)); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (uint8_t *) wmi_buf_data(buf); |
| qdf_mem_copy(cmd, cfg, sizeof(*cfg)); |
| WMI_LOGI(FL("Sending OEM Data Request to target, data len %lu"), |
| sizeof(*cfg)); |
| wmi_mtrace(WMI_OEM_DMA_RING_CFG_REQ_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cfg), |
| WMI_OEM_DMA_RING_CFG_REQ_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL(":wmi cmd send failed")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| #endif |
| |
| /** |
| * send_dbr_cfg_cmd_tlv() - configure DMA rings for Direct Buf RX |
| * @wmi_handle: wmi handle |
| * @data_len: len of dma cfg req |
| * @data: dma cfg req |
| * |
| * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_FAILURE for failure |
| */ |
| static QDF_STATUS send_dbr_cfg_cmd_tlv(wmi_unified_t wmi_handle, |
| struct direct_buf_rx_cfg_req *cfg) |
| { |
| wmi_buf_t buf; |
| wmi_dma_ring_cfg_req_fixed_param *cmd; |
| QDF_STATUS ret; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_dma_ring_cfg_req_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dma_ring_cfg_req_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_dma_ring_cfg_req_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| cfg->pdev_id); |
| cmd->mod_id = cfg->mod_id; |
| cmd->base_paddr_lo = cfg->base_paddr_lo; |
| cmd->base_paddr_hi = cfg->base_paddr_hi; |
| cmd->head_idx_paddr_lo = cfg->head_idx_paddr_lo; |
| cmd->head_idx_paddr_hi = cfg->head_idx_paddr_hi; |
| cmd->tail_idx_paddr_lo = cfg->tail_idx_paddr_lo; |
| cmd->tail_idx_paddr_hi = cfg->tail_idx_paddr_hi; |
| cmd->num_elems = cfg->num_elems; |
| cmd->buf_size = cfg->buf_size; |
| cmd->num_resp_per_event = cfg->num_resp_per_event; |
| cmd->event_timeout_ms = cfg->event_timeout_ms; |
| |
| WMI_LOGD("%s: wmi_dma_ring_cfg_req_fixed_param pdev id %d mod id %d" |
| "base paddr lo %x base paddr hi %x head idx paddr lo %x" |
| "head idx paddr hi %x tail idx paddr lo %x" |
| "tail idx addr hi %x num elems %d buf size %d num resp %d" |
| "event timeout %d\n", __func__, cmd->pdev_id, |
| cmd->mod_id, cmd->base_paddr_lo, cmd->base_paddr_hi, |
| cmd->head_idx_paddr_lo, cmd->head_idx_paddr_hi, |
| cmd->tail_idx_paddr_lo, cmd->tail_idx_paddr_hi, |
| cmd->num_elems, cmd->buf_size, cmd->num_resp_per_event, |
| cmd->event_timeout_ms); |
| wmi_mtrace(WMI_PDEV_DMA_RING_CFG_REQ_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_DMA_RING_CFG_REQ_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL(":wmi cmd send failed")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_start_11d_scan_cmd_tlv() - start 11d scan request |
| * @wmi_handle: wmi handle |
| * @start_11d_scan: 11d scan start request parameters |
| * |
| * This function request FW to start 11d scan. |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_start_11d_scan_cmd_tlv(wmi_unified_t wmi_handle, |
| struct reg_start_11d_scan_req *start_11d_scan) |
| { |
| wmi_11d_scan_start_cmd_fixed_param *cmd; |
| int32_t len; |
| wmi_buf_t buf; |
| int ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_11d_scan_start_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_11d_scan_start_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_11d_scan_start_cmd_fixed_param)); |
| |
| cmd->vdev_id = start_11d_scan->vdev_id; |
| cmd->scan_period_msec = start_11d_scan->scan_period_msec; |
| cmd->start_interval_msec = start_11d_scan->start_interval_msec; |
| |
| WMI_LOGD("vdev %d sending 11D scan start req", cmd->vdev_id); |
| |
| wmi_mtrace(WMI_11D_SCAN_START_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_11D_SCAN_START_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send start 11d scan wmi cmd", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_stop_11d_scan_cmd_tlv() - stop 11d scan request |
| * @wmi_handle: wmi handle |
| * @start_11d_scan: 11d scan stop request parameters |
| * |
| * This function request FW to stop 11d scan. |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_stop_11d_scan_cmd_tlv(wmi_unified_t wmi_handle, |
| struct reg_stop_11d_scan_req *stop_11d_scan) |
| { |
| wmi_11d_scan_stop_cmd_fixed_param *cmd; |
| int32_t len; |
| wmi_buf_t buf; |
| int ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_11d_scan_stop_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_11d_scan_stop_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_11d_scan_stop_cmd_fixed_param)); |
| |
| cmd->vdev_id = stop_11d_scan->vdev_id; |
| |
| WMI_LOGD("vdev %d sending 11D scan stop req", cmd->vdev_id); |
| |
| wmi_mtrace(WMI_11D_SCAN_STOP_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_11D_SCAN_STOP_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send stop 11d scan wmi cmd", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_start_oem_data_cmd_tlv() - start OEM data request to target |
| * @wmi_handle: wmi handle |
| * @startOemDataReq: start request params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_start_oem_data_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t data_len, |
| uint8_t *data) |
| { |
| wmi_buf_t buf; |
| uint8_t *cmd; |
| QDF_STATUS ret; |
| |
| buf = wmi_buf_alloc(wmi_handle, |
| (data_len + WMI_TLV_HDR_SIZE)); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (uint8_t *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(cmd, WMITLV_TAG_ARRAY_BYTE, data_len); |
| cmd += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(cmd, data, |
| data_len); |
| |
| WMI_LOGD(FL("Sending OEM Data Request to target, data len %d"), |
| data_len); |
| |
| wmi_mtrace(WMI_OEM_REQ_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, |
| (data_len + |
| WMI_TLV_HDR_SIZE), WMI_OEM_REQ_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL(":wmi cmd send failed")); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_dfs_phyerr_filter_offload_en_cmd_tlv() - enable dfs phyerr filter |
| * @wmi_handle: wmi handle |
| * @dfs_phyerr_filter_offload: is dfs phyerr filter offload |
| * |
| * Send WMI_DFS_PHYERR_FILTER_ENA_CMDID or |
| * WMI_DFS_PHYERR_FILTER_DIS_CMDID command |
| * to firmware based on phyerr filtering |
| * offload status. |
| * |
| * Return: 1 success, 0 failure |
| */ |
| static QDF_STATUS |
| send_dfs_phyerr_filter_offload_en_cmd_tlv(wmi_unified_t wmi_handle, |
| bool dfs_phyerr_filter_offload) |
| { |
| wmi_dfs_phyerr_filter_ena_cmd_fixed_param *enable_phyerr_offload_cmd; |
| wmi_dfs_phyerr_filter_dis_cmd_fixed_param *disable_phyerr_offload_cmd; |
| wmi_buf_t buf; |
| uint16_t len; |
| QDF_STATUS ret; |
| |
| |
| if (false == dfs_phyerr_filter_offload) { |
| WMI_LOGD("%s:Phyerror Filtering offload is Disabled in ini", |
| __func__); |
| len = sizeof(*disable_phyerr_offload_cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return 0; |
| } |
| disable_phyerr_offload_cmd = |
| (wmi_dfs_phyerr_filter_dis_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&disable_phyerr_offload_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dfs_phyerr_filter_dis_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_dfs_phyerr_filter_dis_cmd_fixed_param)); |
| |
| /* |
| * Send WMI_DFS_PHYERR_FILTER_DIS_CMDID |
| * to the firmware to disable the phyerror |
| * filtering offload. |
| */ |
| wmi_mtrace(WMI_DFS_PHYERR_FILTER_DIS_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_DFS_PHYERR_FILTER_DIS_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send WMI_DFS_PHYERR_FILTER_DIS_CMDID ret=%d", |
| __func__, ret); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: WMI_DFS_PHYERR_FILTER_DIS_CMDID Send Success", |
| __func__); |
| } else { |
| WMI_LOGD("%s:Phyerror Filtering offload is Enabled in ini", |
| __func__); |
| |
| len = sizeof(*enable_phyerr_offload_cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| enable_phyerr_offload_cmd = |
| (wmi_dfs_phyerr_filter_ena_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&enable_phyerr_offload_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_dfs_phyerr_filter_ena_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_dfs_phyerr_filter_ena_cmd_fixed_param)); |
| |
| /* |
| * Send a WMI_DFS_PHYERR_FILTER_ENA_CMDID |
| * to the firmware to enable the phyerror |
| * filtering offload. |
| */ |
| wmi_mtrace(WMI_DFS_PHYERR_FILTER_ENA_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_DFS_PHYERR_FILTER_ENA_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send DFS PHYERR CMD ret=%d", |
| __func__, ret); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: WMI_DFS_PHYERR_FILTER_ENA_CMDID Send Success", |
| __func__); |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_wow_timer_pattern_cmd_tlv() - set timer pattern tlv, so that firmware |
| * will wake up host after specified time is elapsed |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @cookie: value to identify reason why host set up wake call. |
| * @time: time in ms |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_wow_timer_pattern_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, uint32_t cookie, uint32_t time) |
| { |
| WMI_WOW_ADD_PATTERN_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param) + |
| WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_BITMAP_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_IPV4_SYNC_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_IPV6_SYNC_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + 0 * sizeof(WOW_MAGIC_PATTERN_CMD) + |
| WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t) + |
| WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_WOW_ADD_PATTERN_CMD_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_WOW_ADD_PATTERN_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_WOW_ADD_PATTERN_CMD_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->pattern_id = cookie, |
| cmd->pattern_type = WOW_TIMER_PATTERN; |
| buf_ptr += sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param); |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_BITMAP_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV4_SYNC_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV6_SYNC_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_MAGIC_PATTERN_CMD but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for pattern_info_timeout, and time value */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, sizeof(uint32_t)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| *((uint32_t *) buf_ptr) = time; |
| buf_ptr += sizeof(uint32_t); |
| |
| /* Fill TLV for ra_ratelimit_interval. with dummy 0 value */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, sizeof(uint32_t)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| *((uint32_t *) buf_ptr) = 0; |
| |
| WMI_LOGD("%s: send wake timer pattern with time[%d] to fw vdev = %d", |
| __func__, time, vdev_id); |
| |
| wmi_mtrace(WMI_WOW_ADD_WAKE_PATTERN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_ADD_WAKE_PATTERN_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send wake timer pattern to fw", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #if !defined(REMOVE_PKT_LOG) |
| /** |
| * send_pktlog_wmi_send_cmd_tlv() - send pktlog enable/disable command to target |
| * @wmi_handle: wmi handle |
| * @pktlog_event: pktlog event |
| * @cmd_id: pktlog cmd id |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_pktlog_wmi_send_cmd_tlv(wmi_unified_t wmi_handle, |
| WMI_PKTLOG_EVENT pktlog_event, |
| WMI_CMD_ID cmd_id, uint8_t user_triggered) |
| { |
| WMI_PKTLOG_EVENT PKTLOG_EVENT; |
| WMI_CMD_ID CMD_ID; |
| wmi_pdev_pktlog_enable_cmd_fixed_param *cmd; |
| wmi_pdev_pktlog_disable_cmd_fixed_param *disable_cmd; |
| int len = 0; |
| wmi_buf_t buf; |
| |
| PKTLOG_EVENT = pktlog_event; |
| CMD_ID = cmd_id; |
| |
| switch (CMD_ID) { |
| case WMI_PDEV_PKTLOG_ENABLE_CMDID: |
| len = sizeof(*cmd); |
| 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_pktlog_enable_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_pktlog_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_pktlog_enable_cmd_fixed_param)); |
| cmd->evlist = PKTLOG_EVENT; |
| cmd->enable = user_triggered ? WMI_PKTLOG_ENABLE_FORCE |
| : WMI_PKTLOG_ENABLE_AUTO; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| wmi_mtrace(WMI_PDEV_PKTLOG_ENABLE_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_PKTLOG_ENABLE_CMDID)) { |
| WMI_LOGE("failed to send pktlog enable cmdid"); |
| goto wmi_send_failed; |
| } |
| break; |
| case WMI_PDEV_PKTLOG_DISABLE_CMDID: |
| len = sizeof(*disable_cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| disable_cmd = (wmi_pdev_pktlog_disable_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&disable_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_pktlog_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_pktlog_disable_cmd_fixed_param)); |
| disable_cmd->pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| wmi_mtrace(WMI_PDEV_PKTLOG_DISABLE_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_PKTLOG_DISABLE_CMDID)) { |
| WMI_LOGE("failed to send pktlog disable cmdid"); |
| goto wmi_send_failed; |
| } |
| break; |
| default: |
| WMI_LOGD("%s: invalid PKTLOG command", __func__); |
| break; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| |
| wmi_send_failed: |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| #endif /* REMOVE_PKT_LOG */ |
| |
| /** |
| * send_wow_delete_pattern_cmd_tlv() - delete wow pattern in target |
| * @wmi_handle: wmi handle |
| * @ptrn_id: pattern id |
| * @vdev_id: vdev id |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_wow_delete_pattern_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t ptrn_id, uint8_t vdev_id) |
| { |
| WMI_WOW_DEL_PATTERN_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(WMI_WOW_DEL_PATTERN_CMD_fixed_param); |
| |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_WOW_DEL_PATTERN_CMD_fixed_param *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_WOW_DEL_PATTERN_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| WMI_WOW_DEL_PATTERN_CMD_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->pattern_id = ptrn_id; |
| cmd->pattern_type = WOW_BITMAP_PATTERN; |
| |
| WMI_LOGI("Deleting pattern id: %d vdev id %d in fw", |
| cmd->pattern_id, vdev_id); |
| |
| wmi_mtrace(WMI_WOW_DEL_WAKE_PATTERN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_DEL_WAKE_PATTERN_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to delete wow ptrn from fw", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_host_wakeup_ind_to_fw_cmd_tlv() - send wakeup ind to fw |
| * @wmi_handle: wmi handle |
| * |
| * Sends host wakeup indication to FW. On receiving this indication, |
| * FW will come out of WOW. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_host_wakeup_ind_to_fw_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_wow_hostwakeup_from_sleep_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS qdf_status = QDF_STATUS_SUCCESS; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(wmi_wow_hostwakeup_from_sleep_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_wow_hostwakeup_from_sleep_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wow_hostwakeup_from_sleep_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_wow_hostwakeup_from_sleep_cmd_fixed_param)); |
| |
| |
| wmi_mtrace(WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID); |
| if (ret) { |
| WMI_LOGE("Failed to send host wakeup indication to fw"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return qdf_status; |
| } |
| |
| /** |
| * send_del_ts_cmd_tlv() - send DELTS request to fw |
| * @wmi_handle: wmi handle |
| * @msg: delts params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_del_ts_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id, |
| uint8_t ac) |
| { |
| wmi_vdev_wmm_delts_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_wmm_delts_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_wmm_delts_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_wmm_delts_cmd_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->ac = ac; |
| |
| WMI_LOGD("Delts vdev:%d, ac:%d, %s:%d", |
| cmd->vdev_id, cmd->ac, __func__, __LINE__); |
| wmi_mtrace(WMI_VDEV_WMM_DELTS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_WMM_DELTS_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev DELTS command", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_aggr_qos_cmd_tlv() - send aggr qos request to fw |
| * @wmi_handle: handle to wmi |
| * @aggr_qos_rsp_msg - combined struct for all ADD_TS requests. |
| * |
| * A function to handle WMI_AGGR_QOS_REQ. This will send out |
| * ADD_TS requestes to firmware in loop for all the ACs with |
| * active flow. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_aggr_qos_cmd_tlv(wmi_unified_t wmi_handle, |
| struct aggr_add_ts_param *aggr_qos_rsp_msg) |
| { |
| int i = 0; |
| wmi_vdev_wmm_addts_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| for (i = 0; i < WMI_QOS_NUM_AC_MAX; i++) { |
| /* if flow in this AC is active */ |
| if (((1 << i) & aggr_qos_rsp_msg->tspecIdx)) { |
| /* |
| * as per implementation of wma_add_ts_req() we |
| * are not waiting any response from firmware so |
| * apart from sending ADDTS to firmware just send |
| * success to upper layers |
| */ |
| aggr_qos_rsp_msg->status[i] = QDF_STATUS_SUCCESS; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_wmm_addts_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_wmm_addts_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_wmm_addts_cmd_fixed_param)); |
| cmd->vdev_id = aggr_qos_rsp_msg->vdev_id; |
| cmd->ac = |
| WMI_TID_TO_AC(aggr_qos_rsp_msg->tspec[i].tsinfo. |
| traffic.userPrio); |
| cmd->medium_time_us = |
| aggr_qos_rsp_msg->tspec[i].mediumTime * 32; |
| cmd->downgrade_type = WMM_AC_DOWNGRADE_DEPRIO; |
| WMI_LOGD("%s:%d: Addts vdev:%d, ac:%d, mediumTime:%d downgrade_type:%d", |
| __func__, __LINE__, cmd->vdev_id, cmd->ac, |
| cmd->medium_time_us, cmd->downgrade_type); |
| wmi_mtrace(WMI_VDEV_WMM_ADDTS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send |
| (wmi_handle, buf, len, |
| WMI_VDEV_WMM_ADDTS_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev ADDTS command", |
| __func__); |
| aggr_qos_rsp_msg->status[i] = |
| QDF_STATUS_E_FAILURE; |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| } |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_add_ts_cmd_tlv() - send ADDTS request to fw |
| * @wmi_handle: wmi handle |
| * @msg: ADDTS params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_add_ts_cmd_tlv(wmi_unified_t wmi_handle, |
| struct add_ts_param *msg) |
| { |
| wmi_vdev_wmm_addts_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| msg->status = QDF_STATUS_SUCCESS; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_vdev_wmm_addts_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_wmm_addts_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_wmm_addts_cmd_fixed_param)); |
| cmd->vdev_id = msg->sme_session_id; |
| cmd->ac = msg->tspec.tsinfo.traffic.userPrio; |
| cmd->medium_time_us = msg->tspec.mediumTime * 32; |
| cmd->downgrade_type = WMM_AC_DOWNGRADE_DROP; |
| WMI_LOGD("Addts vdev:%d, ac:%d, mediumTime:%d, downgrade_type:%d %s:%d", |
| cmd->vdev_id, cmd->ac, cmd->medium_time_us, |
| cmd->downgrade_type, __func__, __LINE__); |
| wmi_mtrace(WMI_VDEV_WMM_ADDTS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_WMM_ADDTS_CMDID)) { |
| WMI_LOGP("%s: Failed to send vdev ADDTS command", __func__); |
| msg->status = QDF_STATUS_E_FAILURE; |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_process_add_periodic_tx_ptrn_cmd_tlv - add periodic tx ptrn |
| * @wmi_handle: wmi handle |
| * @pAddPeriodicTxPtrnParams: tx ptrn params |
| * |
| * Retrun: CDF status |
| */ |
| static QDF_STATUS send_process_add_periodic_tx_ptrn_cmd_tlv(wmi_unified_t wmi_handle, |
| struct periodic_tx_pattern * |
| pAddPeriodicTxPtrnParams, |
| uint8_t vdev_id) |
| { |
| WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len; |
| uint8_t *buf_ptr; |
| uint32_t ptrn_len, ptrn_len_aligned; |
| int j; |
| |
| ptrn_len = pAddPeriodicTxPtrnParams->ucPtrnSize; |
| ptrn_len_aligned = roundup(ptrn_len, sizeof(uint32_t)); |
| len = sizeof(WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param) + |
| WMI_TLV_HDR_SIZE + ptrn_len_aligned; |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| |
| cmd = (WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param)); |
| |
| /* Pass the pattern id to delete for the corresponding vdev id */ |
| cmd->vdev_id = vdev_id; |
| cmd->pattern_id = pAddPeriodicTxPtrnParams->ucPtrnId; |
| cmd->timeout = pAddPeriodicTxPtrnParams->usPtrnIntervalMs; |
| cmd->length = pAddPeriodicTxPtrnParams->ucPtrnSize; |
| |
| /* Pattern info */ |
| buf_ptr += sizeof(WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, ptrn_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, pAddPeriodicTxPtrnParams->ucPattern, ptrn_len); |
| for (j = 0; j < pAddPeriodicTxPtrnParams->ucPtrnSize; j++) |
| WMI_LOGD("%s: Add Ptrn: %02x", __func__, buf_ptr[j] & 0xff); |
| |
| WMI_LOGD("%s: Add ptrn id: %d vdev_id: %d", |
| __func__, cmd->pattern_id, cmd->vdev_id); |
| |
| wmi_mtrace(WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_ADD_PROACTIVE_ARP_RSP_PATTERN_CMDID)) { |
| WMI_LOGE("%s: failed to add pattern set state command", |
| __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_process_del_periodic_tx_ptrn_cmd_tlv - del periodic tx ptrn |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @pattern_id: pattern id |
| * |
| * Retrun: CDF status |
| */ |
| static QDF_STATUS send_process_del_periodic_tx_ptrn_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, |
| uint8_t pattern_id) |
| { |
| WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len = |
| sizeof(WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param); |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param *) |
| wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMD_fixed_param)); |
| |
| /* Pass the pattern id to delete for the corresponding vdev id */ |
| cmd->vdev_id = vdev_id; |
| cmd->pattern_id = pattern_id; |
| WMI_LOGD("%s: Del ptrn id: %d vdev_id: %d", |
| __func__, cmd->pattern_id, cmd->vdev_id); |
| |
| wmi_mtrace(WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_DEL_PROACTIVE_ARP_RSP_PATTERN_CMDID)) { |
| WMI_LOGE("%s: failed to send del pattern command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_stats_ext_req_cmd_tlv() - request ext stats from fw |
| * @wmi_handle: wmi handle |
| * @preq: stats ext params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_stats_ext_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct stats_ext_params *preq) |
| { |
| QDF_STATUS ret; |
| wmi_req_stats_ext_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| size_t len; |
| uint8_t *buf_ptr; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + preq->request_data_len; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_req_stats_ext_cmd_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_req_stats_ext_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_req_stats_ext_cmd_fixed_param)); |
| cmd->vdev_id = preq->vdev_id; |
| cmd->data_len = preq->request_data_len; |
| |
| WMI_LOGD("%s: The data len value is %u and vdev id set is %u ", |
| __func__, preq->request_data_len, preq->vdev_id); |
| |
| buf_ptr += sizeof(wmi_req_stats_ext_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, cmd->data_len); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, preq->request_data, cmd->data_len); |
| |
| wmi_mtrace(WMI_REQUEST_STATS_EXT_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_STATS_EXT_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send notify cmd ret = %d", __func__, |
| ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_enable_ext_wow_cmd_tlv() - enable ext wow in fw |
| * @wmi_handle: wmi handle |
| * @params: ext wow params |
| * |
| * Return:0 for success or error code |
| */ |
| static QDF_STATUS send_enable_ext_wow_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ext_wow_params *params) |
| { |
| wmi_extwow_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(wmi_extwow_enable_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_extwow_enable_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_extwow_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_extwow_enable_cmd_fixed_param)); |
| |
| cmd->vdev_id = params->vdev_id; |
| cmd->type = params->type; |
| cmd->wakeup_pin_num = params->wakeup_pin_num; |
| |
| WMI_LOGD("%s: vdev_id %d type %d Wakeup_pin_num %x", |
| __func__, cmd->vdev_id, cmd->type, cmd->wakeup_pin_num); |
| |
| wmi_mtrace(WMI_EXTWOW_ENABLE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_EXTWOW_ENABLE_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to set EXTWOW Enable", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| |
| } |
| |
| /** |
| * send_app_type1_params_in_fw_cmd_tlv() - set app type1 params in fw |
| * @wmi_handle: wmi handle |
| * @app_type1_params: app type1 params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_app_type1_params_in_fw_cmd_tlv(wmi_unified_t wmi_handle, |
| struct app_type1_params *app_type1_params) |
| { |
| wmi_extwow_set_app_type1_params_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(wmi_extwow_set_app_type1_params_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_extwow_set_app_type1_params_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_extwow_set_app_type1_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_extwow_set_app_type1_params_cmd_fixed_param)); |
| |
| cmd->vdev_id = app_type1_params->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(app_type1_params->wakee_mac_addr.bytes, |
| &cmd->wakee_mac); |
| qdf_mem_copy(cmd->ident, app_type1_params->identification_id, 8); |
| cmd->ident_len = app_type1_params->id_length; |
| qdf_mem_copy(cmd->passwd, app_type1_params->password, 16); |
| cmd->passwd_len = app_type1_params->pass_length; |
| |
| WMI_LOGD("%s: vdev_id %d wakee_mac_addr %pM " |
| "identification_id %.8s id_length %u " |
| "password %.16s pass_length %u", |
| __func__, cmd->vdev_id, app_type1_params->wakee_mac_addr.bytes, |
| cmd->ident, cmd->ident_len, cmd->passwd, cmd->passwd_len); |
| |
| wmi_mtrace(WMI_EXTWOW_SET_APP_TYPE1_PARAMS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_EXTWOW_SET_APP_TYPE1_PARAMS_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to set APP TYPE1 PARAMS", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_set_app_type2_params_in_fw_cmd_tlv() - set app type2 params in fw |
| * @wmi_handle: wmi handle |
| * @appType2Params: app type2 params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_app_type2_params_in_fw_cmd_tlv(wmi_unified_t wmi_handle, |
| struct app_type2_params *appType2Params) |
| { |
| wmi_extwow_set_app_type2_params_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(wmi_extwow_set_app_type2_params_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_extwow_set_app_type2_params_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_extwow_set_app_type2_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_extwow_set_app_type2_params_cmd_fixed_param)); |
| |
| cmd->vdev_id = appType2Params->vdev_id; |
| |
| qdf_mem_copy(cmd->rc4_key, appType2Params->rc4_key, 16); |
| cmd->rc4_key_len = appType2Params->rc4_key_len; |
| |
| cmd->ip_id = appType2Params->ip_id; |
| cmd->ip_device_ip = appType2Params->ip_device_ip; |
| cmd->ip_server_ip = appType2Params->ip_server_ip; |
| |
| cmd->tcp_src_port = appType2Params->tcp_src_port; |
| cmd->tcp_dst_port = appType2Params->tcp_dst_port; |
| cmd->tcp_seq = appType2Params->tcp_seq; |
| cmd->tcp_ack_seq = appType2Params->tcp_ack_seq; |
| |
| cmd->keepalive_init = appType2Params->keepalive_init; |
| cmd->keepalive_min = appType2Params->keepalive_min; |
| cmd->keepalive_max = appType2Params->keepalive_max; |
| cmd->keepalive_inc = appType2Params->keepalive_inc; |
| |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(appType2Params->gateway_mac.bytes, |
| &cmd->gateway_mac); |
| cmd->tcp_tx_timeout_val = appType2Params->tcp_tx_timeout_val; |
| cmd->tcp_rx_timeout_val = appType2Params->tcp_rx_timeout_val; |
| |
| WMI_LOGD("%s: vdev_id %d gateway_mac %pM " |
| "rc4_key %.16s rc4_key_len %u " |
| "ip_id %x ip_device_ip %x ip_server_ip %x " |
| "tcp_src_port %u tcp_dst_port %u tcp_seq %u " |
| "tcp_ack_seq %u keepalive_init %u keepalive_min %u " |
| "keepalive_max %u keepalive_inc %u " |
| "tcp_tx_timeout_val %u tcp_rx_timeout_val %u", |
| __func__, cmd->vdev_id, appType2Params->gateway_mac.bytes, |
| cmd->rc4_key, cmd->rc4_key_len, |
| cmd->ip_id, cmd->ip_device_ip, cmd->ip_server_ip, |
| cmd->tcp_src_port, cmd->tcp_dst_port, cmd->tcp_seq, |
| cmd->tcp_ack_seq, cmd->keepalive_init, cmd->keepalive_min, |
| cmd->keepalive_max, cmd->keepalive_inc, |
| cmd->tcp_tx_timeout_val, cmd->tcp_rx_timeout_val); |
| |
| wmi_mtrace(WMI_EXTWOW_SET_APP_TYPE2_PARAMS_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_EXTWOW_SET_APP_TYPE2_PARAMS_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to set APP TYPE2 PARAMS", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| |
| } |
| |
| /** |
| * send_set_auto_shutdown_timer_cmd_tlv() - sets auto shutdown timer in firmware |
| * @wmi_handle: wmi handle |
| * @timer_val: auto shutdown timer value |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_auto_shutdown_timer_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t timer_val) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_host_auto_shutdown_cfg_cmd_fixed_param *wmi_auto_sh_cmd; |
| int len = sizeof(wmi_host_auto_shutdown_cfg_cmd_fixed_param); |
| |
| WMI_LOGD("%s: Set WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID:TIMER_VAL=%d", |
| __func__, timer_val); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| wmi_auto_sh_cmd = |
| (wmi_host_auto_shutdown_cfg_cmd_fixed_param *) buf_ptr; |
| wmi_auto_sh_cmd->timer_value = timer_val; |
| |
| WMITLV_SET_HDR(&wmi_auto_sh_cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_host_auto_shutdown_cfg_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_host_auto_shutdown_cfg_cmd_fixed_param)); |
| |
| wmi_mtrace(WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("%s: WMI_HOST_AUTO_SHUTDOWN_CFG_CMDID Err %d", |
| __func__, status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_nan_req_cmd_tlv() - to send nan request to target |
| * @wmi_handle: wmi handle |
| * @nan_req: request data which will be non-null |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_nan_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct nan_req_params *nan_req) |
| { |
| QDF_STATUS ret; |
| wmi_nan_cmd_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len = sizeof(*cmd); |
| uint16_t nan_data_len, nan_data_len_aligned; |
| uint8_t *buf_ptr; |
| |
| /* |
| * <----- cmd ------------><-- WMI_TLV_HDR_SIZE --><--- data ----> |
| * +------------+----------+-----------------------+--------------+ |
| * | tlv_header | data_len | WMITLV_TAG_ARRAY_BYTE | nan_req_data | |
| * +------------+----------+-----------------------+--------------+ |
| */ |
| if (!nan_req) { |
| WMI_LOGE("%s:nan req is not valid", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| nan_data_len = nan_req->request_data_len; |
| nan_data_len_aligned = roundup(nan_req->request_data_len, |
| sizeof(uint32_t)); |
| if (nan_data_len_aligned < nan_req->request_data_len) { |
| WMI_LOGE("%s: integer overflow while rounding up data_len", |
| __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (nan_data_len_aligned > WMI_SVC_MSG_MAX_SIZE - WMI_TLV_HDR_SIZE) { |
| WMI_LOGE("%s: wmi_max_msg_size overflow for given datalen", |
| __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| len += WMI_TLV_HDR_SIZE + nan_data_len_aligned; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_nan_cmd_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_nan_cmd_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_nan_cmd_param)); |
| cmd->data_len = nan_req->request_data_len; |
| WMI_LOGD("%s: The data len value is %u", |
| __func__, nan_req->request_data_len); |
| buf_ptr += sizeof(wmi_nan_cmd_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, nan_data_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| qdf_mem_copy(buf_ptr, nan_req->request_data, cmd->data_len); |
| |
| wmi_mtrace(WMI_NAN_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_NAN_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s Failed to send set param command ret = %d", |
| __func__, ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_process_dhcpserver_offload_cmd_tlv() - enable DHCP server offload |
| * @wmi_handle: wmi handle |
| * @params: DHCP server offload info |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS |
| send_process_dhcpserver_offload_cmd_tlv(wmi_unified_t wmi_handle, |
| struct dhcp_offload_info_params *params) |
| { |
| wmi_set_dhcp_server_offload_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send " |
| "set_dhcp_server_offload cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_set_dhcp_server_offload_cmd_fixed_param *) wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_set_dhcp_server_offload_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_set_dhcp_server_offload_cmd_fixed_param)); |
| cmd->vdev_id = params->vdev_id; |
| cmd->enable = params->dhcp_offload_enabled; |
| cmd->num_client = params->dhcp_client_num; |
| cmd->srv_ipv4 = params->dhcp_srv_addr; |
| cmd->start_lsb = 0; |
| wmi_mtrace(WMI_SET_DHCP_SERVER_OFFLOAD_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), |
| WMI_SET_DHCP_SERVER_OFFLOAD_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("Failed to send set_dhcp_server_offload cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("Set dhcp server offload to vdevId %d", |
| params->vdev_id); |
| |
| return status; |
| } |
| |
| /** |
| * send_set_led_flashing_cmd_tlv() - set led flashing in fw |
| * @wmi_handle: wmi handle |
| * @flashing: flashing request |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_set_led_flashing_cmd_tlv(wmi_unified_t wmi_handle, |
| struct flashing_req_params *flashing) |
| { |
| wmi_set_led_flashing_cmd_fixed_param *cmd; |
| QDF_STATUS status; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t len = sizeof(wmi_set_led_flashing_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_set_led_flashing_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_set_led_flashing_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_set_led_flashing_cmd_fixed_param)); |
| cmd->pattern_id = flashing->pattern_id; |
| cmd->led_x0 = flashing->led_x0; |
| cmd->led_x1 = flashing->led_x1; |
| |
| wmi_mtrace(WMI_PDEV_SET_LED_FLASHING_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_LED_FLASHING_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("%s: wmi_unified_cmd_send WMI_PEER_SET_PARAM_CMD" |
| " returned Error %d", __func__, status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_process_ch_avoid_update_cmd_tlv() - handles channel avoid update request |
| * @wmi_handle: wmi handle |
| * @ch_avoid_update_req: channel avoid update params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_process_ch_avoid_update_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_chan_avoid_update_cmd_param *ch_avoid_update_fp; |
| int len = sizeof(wmi_chan_avoid_update_cmd_param); |
| |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| ch_avoid_update_fp = (wmi_chan_avoid_update_cmd_param *) buf_ptr; |
| WMITLV_SET_HDR(&ch_avoid_update_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_chan_avoid_update_cmd_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_chan_avoid_update_cmd_param)); |
| |
| wmi_mtrace(WMI_CHAN_AVOID_UPDATE_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_CHAN_AVOID_UPDATE_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send" |
| " WMITLV_TABLE_WMI_CHAN_AVOID_UPDATE" |
| " returned Error %d", status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_pdev_set_regdomain_cmd_tlv() - send set regdomain command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to pdev regdomain params |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| send_pdev_set_regdomain_cmd_tlv(wmi_unified_t wmi_handle, |
| struct pdev_set_regdomain_params *param) |
| { |
| wmi_buf_t buf; |
| wmi_pdev_set_regdomain_cmd_fixed_param *cmd; |
| int32_t len = sizeof(*cmd); |
| |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_pdev_set_regdomain_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_regdomain_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_set_regdomain_cmd_fixed_param)); |
| |
| cmd->reg_domain = param->currentRDinuse; |
| cmd->reg_domain_2G = param->currentRD2G; |
| cmd->reg_domain_5G = param->currentRD5G; |
| cmd->conformance_test_limit_2G = param->ctl_2G; |
| cmd->conformance_test_limit_5G = param->ctl_5G; |
| cmd->dfs_domain = param->dfsDomain; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| |
| wmi_mtrace(WMI_PDEV_SET_REGDOMAIN_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_REGDOMAIN_CMDID)) { |
| WMI_LOGE("%s: Failed to send pdev set regdomain command", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_regdomain_info_to_fw_cmd_tlv() - send regdomain info to fw |
| * @wmi_handle: wmi handle |
| * @reg_dmn: reg domain |
| * @regdmn2G: 2G reg domain |
| * @regdmn5G: 5G reg domain |
| * @ctl2G: 2G test limit |
| * @ctl5G: 5G test limit |
| * |
| * Return: none |
| */ |
| static QDF_STATUS send_regdomain_info_to_fw_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t reg_dmn, uint16_t regdmn2G, |
| uint16_t regdmn5G, uint8_t ctl2G, |
| uint8_t ctl5G) |
| { |
| wmi_buf_t buf; |
| wmi_pdev_set_regdomain_cmd_fixed_param *cmd; |
| int32_t len = sizeof(*cmd); |
| |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_pdev_set_regdomain_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_regdomain_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_set_regdomain_cmd_fixed_param)); |
| cmd->reg_domain = reg_dmn; |
| cmd->reg_domain_2G = regdmn2G; |
| cmd->reg_domain_5G = regdmn5G; |
| cmd->conformance_test_limit_2G = ctl2G; |
| cmd->conformance_test_limit_5G = ctl5G; |
| |
| wmi_mtrace(WMI_PDEV_SET_REGDOMAIN_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_REGDOMAIN_CMDID)) { |
| WMI_LOGP("%s: Failed to send pdev set regdomain command", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef FEATURE_WLAN_TDLS |
| /** |
| * tdls_get_wmi_offchannel_mode - Get WMI tdls off channel mode |
| * @tdls_sw_mode: tdls_sw_mode |
| * |
| * This function returns wmi tdls offchannel mode |
| * |
| * Return: enum value of wmi tdls offchannel mode |
| */ |
| static uint8_t tdls_get_wmi_offchannel_mode(uint8_t tdls_sw_mode) |
| { |
| uint8_t off_chan_mode; |
| |
| switch (tdls_sw_mode) { |
| case ENABLE_CHANSWITCH: |
| off_chan_mode = WMI_TDLS_ENABLE_OFFCHANNEL; |
| break; |
| |
| case DISABLE_CHANSWITCH: |
| off_chan_mode = WMI_TDLS_DISABLE_OFFCHANNEL; |
| break; |
| |
| default: |
| WMI_LOGD(FL("unknown tdls_sw_mode %d"), tdls_sw_mode); |
| off_chan_mode = WMI_TDLS_DISABLE_OFFCHANNEL; |
| } |
| return off_chan_mode; |
| } |
| #else |
| static uint8_t tdls_get_wmi_offchannel_mode(uint8_t tdls_sw_mode) |
| { |
| return WMI_TDLS_DISABLE_OFFCHANNEL; |
| } |
| #endif |
| |
| /** |
| * send_set_tdls_offchan_mode_cmd_tlv() - set tdls off channel mode |
| * @wmi_handle: wmi handle |
| * @chan_switch_params: Pointer to tdls channel switch parameter structure |
| * |
| * This function sets tdls off channel mode |
| * |
| * Return: 0 on success; Negative errno otherwise |
| */ |
| static QDF_STATUS send_set_tdls_offchan_mode_cmd_tlv(wmi_unified_t wmi_handle, |
| struct tdls_channel_switch_params *chan_switch_params) |
| { |
| wmi_tdls_set_offchan_mode_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| u_int16_t len = sizeof(wmi_tdls_set_offchan_mode_cmd_fixed_param); |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd = (wmi_tdls_set_offchan_mode_cmd_fixed_param *) |
| wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_tdls_set_offchan_mode_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_tdls_set_offchan_mode_cmd_fixed_param)); |
| |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(chan_switch_params->peer_mac_addr, |
| &cmd->peer_macaddr); |
| cmd->vdev_id = chan_switch_params->vdev_id; |
| cmd->offchan_mode = |
| tdls_get_wmi_offchannel_mode(chan_switch_params->tdls_sw_mode); |
| cmd->is_peer_responder = chan_switch_params->is_responder; |
| cmd->offchan_num = chan_switch_params->tdls_off_ch; |
| cmd->offchan_bw_bitmap = chan_switch_params->tdls_off_ch_bw_offset; |
| cmd->offchan_oper_class = chan_switch_params->oper_class; |
| |
| WMI_LOGD(FL("Peer MAC Addr mac_addr31to0: 0x%x, mac_addr47to32: 0x%x"), |
| cmd->peer_macaddr.mac_addr31to0, |
| cmd->peer_macaddr.mac_addr47to32); |
| |
| WMI_LOGD(FL( |
| "vdev_id: %d, off channel mode: %d, off channel Num: %d, " |
| "off channel offset: 0x%x, is_peer_responder: %d, operating class: %d" |
| ), |
| cmd->vdev_id, |
| cmd->offchan_mode, |
| cmd->offchan_num, |
| cmd->offchan_bw_bitmap, |
| cmd->is_peer_responder, |
| cmd->offchan_oper_class); |
| |
| wmi_mtrace(WMI_TDLS_SET_OFFCHAN_MODE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_TDLS_SET_OFFCHAN_MODE_CMDID)) { |
| WMI_LOGP(FL("failed to send tdls off chan command")); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_update_fw_tdls_state_cmd_tlv() - send enable/disable tdls for a vdev |
| * @wmi_handle: wmi handle |
| * @pwmaTdlsparams: TDLS params |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS send_update_fw_tdls_state_cmd_tlv(wmi_unified_t wmi_handle, |
| void *tdls_param, uint8_t tdls_state) |
| { |
| wmi_tdls_set_state_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| |
| struct wmi_tdls_params *wmi_tdls = (struct wmi_tdls_params *) tdls_param; |
| uint16_t len = sizeof(wmi_tdls_set_state_cmd_fixed_param); |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmai_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd = (wmi_tdls_set_state_cmd_fixed_param *) wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_tdls_set_state_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_tdls_set_state_cmd_fixed_param)); |
| cmd->vdev_id = wmi_tdls->vdev_id; |
| cmd->state = tdls_state; |
| cmd->notification_interval_ms = wmi_tdls->notification_interval_ms; |
| cmd->tx_discovery_threshold = wmi_tdls->tx_discovery_threshold; |
| cmd->tx_teardown_threshold = wmi_tdls->tx_teardown_threshold; |
| cmd->rssi_teardown_threshold = wmi_tdls->rssi_teardown_threshold; |
| cmd->rssi_delta = wmi_tdls->rssi_delta; |
| cmd->tdls_options = wmi_tdls->tdls_options; |
| cmd->tdls_peer_traffic_ind_window = wmi_tdls->peer_traffic_ind_window; |
| cmd->tdls_peer_traffic_response_timeout_ms = |
| wmi_tdls->peer_traffic_response_timeout; |
| cmd->tdls_puapsd_mask = wmi_tdls->puapsd_mask; |
| cmd->tdls_puapsd_inactivity_time_ms = wmi_tdls->puapsd_inactivity_time; |
| cmd->tdls_puapsd_rx_frame_threshold = |
| wmi_tdls->puapsd_rx_frame_threshold; |
| cmd->teardown_notification_ms = |
| wmi_tdls->teardown_notification_ms; |
| cmd->tdls_peer_kickout_threshold = |
| wmi_tdls->tdls_peer_kickout_threshold; |
| |
| WMI_LOGD("%s: tdls_state: %d, state: %d, " |
| "notification_interval_ms: %d, " |
| "tx_discovery_threshold: %d, " |
| "tx_teardown_threshold: %d, " |
| "rssi_teardown_threshold: %d, " |
| "rssi_delta: %d, " |
| "tdls_options: 0x%x, " |
| "tdls_peer_traffic_ind_window: %d, " |
| "tdls_peer_traffic_response_timeout: %d, " |
| "tdls_puapsd_mask: 0x%x, " |
| "tdls_puapsd_inactivity_time: %d, " |
| "tdls_puapsd_rx_frame_threshold: %d, " |
| "teardown_notification_ms: %d, " |
| "tdls_peer_kickout_threshold: %d", |
| __func__, tdls_state, cmd->state, |
| cmd->notification_interval_ms, |
| cmd->tx_discovery_threshold, |
| cmd->tx_teardown_threshold, |
| cmd->rssi_teardown_threshold, |
| cmd->rssi_delta, |
| cmd->tdls_options, |
| cmd->tdls_peer_traffic_ind_window, |
| cmd->tdls_peer_traffic_response_timeout_ms, |
| cmd->tdls_puapsd_mask, |
| cmd->tdls_puapsd_inactivity_time_ms, |
| cmd->tdls_puapsd_rx_frame_threshold, |
| cmd->teardown_notification_ms, |
| cmd->tdls_peer_kickout_threshold); |
| |
| wmi_mtrace(WMI_TDLS_SET_STATE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_TDLS_SET_STATE_CMDID)) { |
| WMI_LOGP("%s: failed to send tdls set state command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| WMI_LOGD("%s: vdev_id %d", __func__, wmi_tdls->vdev_id); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_update_tdls_peer_state_cmd_tlv() - update TDLS peer state |
| * @wmi_handle: wmi handle |
| * @peerStateParams: TDLS peer state params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_update_tdls_peer_state_cmd_tlv(wmi_unified_t wmi_handle, |
| struct tdls_peer_state_params *peerStateParams, |
| uint32_t *ch_mhz) |
| { |
| wmi_tdls_peer_update_cmd_fixed_param *cmd; |
| wmi_tdls_peer_capabilities *peer_cap; |
| wmi_channel *chan_info; |
| wmi_buf_t wmi_buf; |
| uint8_t *buf_ptr; |
| uint32_t i; |
| int32_t len = sizeof(wmi_tdls_peer_update_cmd_fixed_param) + |
| sizeof(wmi_tdls_peer_capabilities); |
| |
| |
| len += WMI_TLV_HDR_SIZE + |
| sizeof(wmi_channel) * peerStateParams->peerCap.peerChanLen; |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| cmd = (wmi_tdls_peer_update_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_tdls_peer_update_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_tdls_peer_update_cmd_fixed_param)); |
| |
| cmd->vdev_id = peerStateParams->vdevId; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(peerStateParams->peerMacAddr, |
| &cmd->peer_macaddr); |
| |
| |
| cmd->peer_state = peerStateParams->peerState; |
| |
| WMI_LOGD("%s: vdev_id: %d, peerStateParams->peerMacAddr: %pM, " |
| "peer_macaddr.mac_addr31to0: 0x%x, " |
| "peer_macaddr.mac_addr47to32: 0x%x, peer_state: %d", |
| __func__, cmd->vdev_id, peerStateParams->peerMacAddr, |
| cmd->peer_macaddr.mac_addr31to0, |
| cmd->peer_macaddr.mac_addr47to32, cmd->peer_state); |
| |
| buf_ptr += sizeof(wmi_tdls_peer_update_cmd_fixed_param); |
| peer_cap = (wmi_tdls_peer_capabilities *) buf_ptr; |
| WMITLV_SET_HDR(&peer_cap->tlv_header, |
| WMITLV_TAG_STRUC_wmi_tdls_peer_capabilities, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_tdls_peer_capabilities)); |
| |
| if ((peerStateParams->peerCap.peerUapsdQueue & 0x08) >> 3) |
| WMI_SET_TDLS_PEER_VO_UAPSD(peer_cap); |
| if ((peerStateParams->peerCap.peerUapsdQueue & 0x04) >> 2) |
| WMI_SET_TDLS_PEER_VI_UAPSD(peer_cap); |
| if ((peerStateParams->peerCap.peerUapsdQueue & 0x02) >> 1) |
| WMI_SET_TDLS_PEER_BK_UAPSD(peer_cap); |
| if (peerStateParams->peerCap.peerUapsdQueue & 0x01) |
| WMI_SET_TDLS_PEER_BE_UAPSD(peer_cap); |
| |
| /* Ack and More Data Ack are sent as 0, so no need to set |
| * but fill SP |
| */ |
| WMI_SET_TDLS_PEER_SP_UAPSD(peer_cap, |
| peerStateParams->peerCap.peerMaxSp); |
| |
| peer_cap->buff_sta_support = |
| peerStateParams->peerCap.peerBuffStaSupport; |
| peer_cap->off_chan_support = |
| peerStateParams->peerCap.peerOffChanSupport; |
| peer_cap->peer_curr_operclass = |
| peerStateParams->peerCap.peerCurrOperClass; |
| /* self curr operclass is not being used and so pass op class for |
| * preferred off chan in it. |
| */ |
| peer_cap->self_curr_operclass = |
| peerStateParams->peerCap.opClassForPrefOffChan; |
| peer_cap->peer_chan_len = peerStateParams->peerCap.peerChanLen; |
| peer_cap->peer_operclass_len = |
| peerStateParams->peerCap.peerOperClassLen; |
| |
| WMI_LOGD("%s: peer_operclass_len: %d", |
| __func__, peer_cap->peer_operclass_len); |
| for (i = 0; i < WMI_TDLS_MAX_SUPP_OPER_CLASSES; i++) { |
| peer_cap->peer_operclass[i] = |
| peerStateParams->peerCap.peerOperClass[i]; |
| WMI_LOGD("%s: peer_operclass[%d]: %d", |
| __func__, i, peer_cap->peer_operclass[i]); |
| } |
| |
| peer_cap->is_peer_responder = peerStateParams->peerCap.isPeerResponder; |
| peer_cap->pref_offchan_num = peerStateParams->peerCap.prefOffChanNum; |
| peer_cap->pref_offchan_bw = |
| peerStateParams->peerCap.prefOffChanBandwidth; |
| |
| WMI_LOGD |
| ("%s: peer_qos: 0x%x, buff_sta_support: %d, off_chan_support: %d, " |
| "peer_curr_operclass: %d, self_curr_operclass: %d, peer_chan_len: " |
| "%d, peer_operclass_len: %d, is_peer_responder: %d, pref_offchan_num:" |
| " %d, pref_offchan_bw: %d", |
| __func__, peer_cap->peer_qos, peer_cap->buff_sta_support, |
| peer_cap->off_chan_support, peer_cap->peer_curr_operclass, |
| peer_cap->self_curr_operclass, peer_cap->peer_chan_len, |
| peer_cap->peer_operclass_len, peer_cap->is_peer_responder, |
| peer_cap->pref_offchan_num, peer_cap->pref_offchan_bw); |
| |
| /* next fill variable size array of peer chan info */ |
| buf_ptr += sizeof(wmi_tdls_peer_capabilities); |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_channel) * |
| peerStateParams->peerCap.peerChanLen); |
| chan_info = (wmi_channel *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| |
| for (i = 0; i < peerStateParams->peerCap.peerChanLen; ++i) { |
| WMITLV_SET_HDR(&chan_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| chan_info->mhz = ch_mhz[i]; |
| chan_info->band_center_freq1 = chan_info->mhz; |
| chan_info->band_center_freq2 = 0; |
| |
| WMI_LOGD("%s: chan[%d] = %u", __func__, i, chan_info->mhz); |
| |
| if (peerStateParams->peerCap.peerChan[i].dfsSet) { |
| WMI_SET_CHANNEL_FLAG(chan_info, WMI_CHAN_FLAG_PASSIVE); |
| WMI_LOGI("chan[%d] DFS[%d]\n", |
| peerStateParams->peerCap.peerChan[i].chanId, |
| peerStateParams->peerCap.peerChan[i].dfsSet); |
| } |
| |
| if (chan_info->mhz < WMI_2_4_GHZ_MAX_FREQ) |
| WMI_SET_CHANNEL_MODE(chan_info, MODE_11G); |
| else |
| WMI_SET_CHANNEL_MODE(chan_info, MODE_11A); |
| |
| WMI_SET_CHANNEL_MAX_TX_POWER(chan_info, |
| peerStateParams->peerCap. |
| peerChan[i].pwr); |
| |
| WMI_SET_CHANNEL_REG_POWER(chan_info, |
| peerStateParams->peerCap.peerChan[i]. |
| pwr); |
| WMI_LOGD("Channel TX power[%d] = %u: %d", i, chan_info->mhz, |
| peerStateParams->peerCap.peerChan[i].pwr); |
| |
| chan_info++; |
| } |
| |
| wmi_mtrace(WMI_TDLS_PEER_UPDATE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_TDLS_PEER_UPDATE_CMDID)) { |
| WMI_LOGE("%s: failed to send tdls peer update state command", |
| __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /* |
| * send_process_set_ie_info_cmd_tlv() - Function to send IE info to firmware |
| * @wmi_handle: Pointer to WMi handle |
| * @ie_data: Pointer for ie data |
| * |
| * This function sends IE information to firmware |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| * |
| */ |
| static QDF_STATUS send_process_set_ie_info_cmd_tlv(wmi_unified_t wmi_handle, |
| struct vdev_ie_info_param *ie_info) |
| { |
| wmi_vdev_set_ie_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len, ie_len_aligned; |
| QDF_STATUS ret; |
| |
| |
| ie_len_aligned = roundup(ie_info->length, sizeof(uint32_t)); |
| /* Allocate memory for the WMI command */ |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + ie_len_aligned; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("wmi_buf_alloc failed")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| |
| /* Populate the WMI command */ |
| cmd = (wmi_vdev_set_ie_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_ie_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_set_ie_cmd_fixed_param)); |
| cmd->vdev_id = ie_info->vdev_id; |
| cmd->ie_id = ie_info->ie_id; |
| cmd->ie_len = ie_info->length; |
| cmd->band = ie_info->band; |
| |
| WMI_LOGD(FL("IE:%d of size:%d sent for vdev:%d"), ie_info->ie_id, |
| ie_info->length, ie_info->vdev_id); |
| |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, ie_len_aligned); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| qdf_mem_copy(buf_ptr, ie_info->data, cmd->ie_len); |
| |
| wmi_mtrace(WMI_VDEV_SET_IE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SET_IE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE(FL("Failed to send set IE command ret = %d"), ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_smart_ant_enable_cmd_tlv() - WMI smart ant enable function |
| * |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to antenna param |
| * |
| * This function sends smart antenna enable command to FW |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_smart_ant_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| struct smart_ant_enable_params *param) |
| { |
| /* Send WMI COMMAND to Enable */ |
| wmi_pdev_smart_ant_enable_cmd_fixed_param *cmd; |
| wmi_pdev_smart_ant_gpio_handle *gpio_param; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int len = 0; |
| QDF_STATUS ret; |
| int loop = 0; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += WMI_HAL_MAX_SANTENNA * sizeof(wmi_pdev_smart_ant_gpio_handle); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_pdev_smart_ant_enable_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_smart_ant_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_smart_ant_enable_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| cmd->enable = param->enable; |
| cmd->mode = param->mode; |
| cmd->rx_antenna = param->rx_antenna; |
| cmd->tx_default_antenna = param->rx_antenna; |
| |
| /* TLV indicating array of structures to follow */ |
| buf_ptr += sizeof(wmi_pdev_smart_ant_enable_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| WMI_HAL_MAX_SANTENNA * |
| sizeof(wmi_pdev_smart_ant_gpio_handle)); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| gpio_param = (wmi_pdev_smart_ant_gpio_handle *)buf_ptr; |
| |
| for (loop = 0; loop < WMI_HAL_MAX_SANTENNA; loop++) { |
| WMITLV_SET_HDR(&gpio_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_smart_ant_gpio_handle, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_smart_ant_gpio_handle)); |
| if (param->mode == SMART_ANT_MODE_SERIAL) { |
| if (loop < WMI_HOST_MAX_SERIAL_ANTENNA) { |
| gpio_param->gpio_pin = param->gpio_pin[loop]; |
| gpio_param->gpio_func = param->gpio_func[loop]; |
| } else { |
| gpio_param->gpio_pin = 0; |
| gpio_param->gpio_func = 0; |
| } |
| } else if (param->mode == SMART_ANT_MODE_PARALLEL) { |
| gpio_param->gpio_pin = param->gpio_pin[loop]; |
| gpio_param->gpio_func = param->gpio_func[loop]; |
| } |
| /* Setting it to 0 for now */ |
| gpio_param->pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| gpio_param++; |
| } |
| |
| wmi_mtrace(WMI_PDEV_SMART_ANT_ENABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, |
| len, |
| WMI_PDEV_SMART_ANT_ENABLE_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE(" %s :WMI Failed\n", __func__); |
| WMI_LOGE("enable:%d mode:%d rx_antenna: 0x%08x PINS: [%d %d %d %d] Func[%d %d %d %d] cmdstatus=%d\n", |
| cmd->enable, |
| cmd->mode, |
| cmd->rx_antenna, |
| param->gpio_pin[0], param->gpio_pin[1], |
| param->gpio_pin[2], param->gpio_pin[3], |
| param->gpio_func[0], param->gpio_func[1], |
| param->gpio_func[2], param->gpio_func[3], |
| ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_smart_ant_set_rx_ant_cmd_tlv() - WMI set rx antenna function |
| * |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to rx antenna param |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_smart_ant_set_rx_ant_cmd_tlv(wmi_unified_t wmi_handle, |
| struct smart_ant_rx_ant_params *param) |
| { |
| wmi_pdev_smart_ant_set_rx_antenna_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len; |
| QDF_STATUS ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| WMI_LOGD("%s:\n", __func__); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = wmi_buf_data(buf); |
| cmd = (wmi_pdev_smart_ant_set_rx_antenna_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_smart_ant_set_rx_antenna_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_smart_ant_set_rx_antenna_cmd_fixed_param)); |
| cmd->rx_antenna = param->antenna; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| |
| wmi_mtrace(WMI_PDEV_SMART_ANT_SET_RX_ANTENNA_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, |
| len, |
| WMI_PDEV_SMART_ANT_SET_RX_ANTENNA_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE(" %s :WMI Failed\n", __func__); |
| WMI_LOGE("%s: rx_antenna: 0x%08x cmdstatus=%d\n", |
| __func__, |
| cmd->rx_antenna, |
| ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * 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\n", __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( |
| 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\n", __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\n"); |
| 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\n", __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( |
| 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( |
| 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\n", |
| __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\n")); |
| wmi_buf_free(wmibuf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_vdev_config_ratemask_cmd_tlv() - config ratemask param in fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold config ratemask params |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_vdev_config_ratemask_cmd_tlv(wmi_unified_t wmi_handle, |
| struct config_ratemask_params *param) |
| { |
| wmi_vdev_config_ratemask_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd = (wmi_vdev_config_ratemask_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_config_ratemask_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_config_ratemask_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->type = param->type; |
| cmd->mask_lower32 = param->lower32; |
| cmd->mask_higher32 = param->higher32; |
| cmd->mask_lower32_2 = param->lower32_2; |
| WMI_LOGI("Setting vdev ratemask vdev id = 0x%X, type = 0x%X" |
| "mask_l32 = 0x%X mask_h32 = 0x%X mask_l32_2 = 0x%X\n", |
| param->vdev_id, param->type, param->lower32, |
| param->higher32, param->lower32_2); |
| |
| wmi_mtrace(WMI_VDEV_RATEMASK_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_RATEMASK_CMDID)) { |
| WMI_LOGE("Seting vdev ratemask failed\n"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * copy_custom_aggr_bitmap() - copies host side bitmap using FW APIs |
| * @param: param sent from the host side |
| * @cmd: param to be sent to the fw side |
| */ |
| static inline void copy_custom_aggr_bitmap( |
| struct set_custom_aggr_size_params *param, |
| wmi_vdev_set_custom_aggr_size_cmd_fixed_param *cmd) |
| { |
| WMI_VDEV_CUSTOM_AGGR_AC_SET(cmd->enable_bitmap, |
| param->ac); |
| WMI_VDEV_CUSTOM_AGGR_TYPE_SET(cmd->enable_bitmap, |
| param->aggr_type); |
| WMI_VDEV_CUSTOM_TX_AGGR_SZ_DIS_SET(cmd->enable_bitmap, |
| param->tx_aggr_size_disable); |
| WMI_VDEV_CUSTOM_RX_AGGR_SZ_DIS_SET(cmd->enable_bitmap, |
| param->rx_aggr_size_disable); |
| WMI_VDEV_CUSTOM_TX_AC_EN_SET(cmd->enable_bitmap, |
| param->tx_ac_enable); |
| } |
| |
| /** |
| * send_vdev_set_custom_aggr_size_cmd_tlv() - custom aggr size param in fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold custom aggr size params |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_vdev_set_custom_aggr_size_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| struct set_custom_aggr_size_params *param) |
| { |
| wmi_vdev_set_custom_aggr_size_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd = (wmi_vdev_set_custom_aggr_size_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_custom_aggr_size_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_set_custom_aggr_size_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->tx_aggr_size = param->tx_aggr_size; |
| cmd->rx_aggr_size = param->rx_aggr_size; |
| copy_custom_aggr_bitmap(param, cmd); |
| |
| WMI_LOGD("Set custom aggr: vdev id=0x%X, tx aggr size=0x%X " |
| "rx_aggr_size=0x%X access category=0x%X, agg_type=0x%X " |
| "tx_aggr_size_disable=0x%X, rx_aggr_size_disable=0x%X " |
| "tx_ac_enable=0x%X\n", |
| param->vdev_id, param->tx_aggr_size, param->rx_aggr_size, |
| param->ac, param->aggr_type, param->tx_aggr_size_disable, |
| param->rx_aggr_size_disable, param->tx_ac_enable); |
| |
| wmi_mtrace(WMI_VDEV_SET_CUSTOM_AGGR_SIZE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SET_CUSTOM_AGGR_SIZE_CMDID)) { |
| WMI_LOGE("Seting custom aggregation size failed\n"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_vdev_set_qdepth_thresh_cmd_tlv() - WMI set qdepth threshold |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to tx antenna param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| |
| static QDF_STATUS send_vdev_set_qdepth_thresh_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_qdepth_thresh_params *param) |
| { |
| wmi_peer_tid_msduq_qdepth_thresh_update_cmd_fixed_param *cmd; |
| wmi_msduq_qdepth_thresh_update *cmd_update; |
| wmi_buf_t buf; |
| int32_t len = 0; |
| int i; |
| uint8_t *buf_ptr; |
| QDF_STATUS ret; |
| |
| if (param->num_of_msduq_updates > QDEPTH_THRESH_MAX_UPDATES) { |
| WMI_LOGE("%s: Invalid Update Count!\n", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += (sizeof(wmi_msduq_qdepth_thresh_update) * |
| param->num_of_msduq_updates); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_peer_tid_msduq_qdepth_thresh_update_cmd_fixed_param *) |
| buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_tid_msduq_qdepth_thresh_update_cmd_fixed_param |
| , WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_tid_msduq_qdepth_thresh_update_cmd_fixed_param)); |
| |
| cmd->pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target(param->pdev_id); |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(param->mac_addr, &cmd->peer_mac_address); |
| cmd->num_of_msduq_updates = param->num_of_msduq_updates; |
| |
| buf_ptr += sizeof( |
| wmi_peer_tid_msduq_qdepth_thresh_update_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| param->num_of_msduq_updates * |
| sizeof(wmi_msduq_qdepth_thresh_update)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| cmd_update = (wmi_msduq_qdepth_thresh_update *)buf_ptr; |
| |
| for (i = 0; i < cmd->num_of_msduq_updates; i++) { |
| WMITLV_SET_HDR(&cmd_update->tlv_header, |
| WMITLV_TAG_STRUC_wmi_msduq_qdepth_thresh_update, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_msduq_qdepth_thresh_update)); |
| cmd_update->tid_num = param->update_params[i].tid_num; |
| cmd_update->msduq_update_mask = |
| param->update_params[i].msduq_update_mask; |
| cmd_update->qdepth_thresh_value = |
| param->update_params[i].qdepth_thresh_value; |
| WMI_LOGD("Set QDepth Threshold: vdev=0x%X pdev=0x%X, tid=0x%X " |
| "mac_addr_upper4=%X, mac_addr_lower2:%X," |
| " update mask=0x%X thresh val=0x%X\n", |
| cmd->vdev_id, cmd->pdev_id, cmd_update->tid_num, |
| cmd->peer_mac_address.mac_addr31to0, |
| cmd->peer_mac_address.mac_addr47to32, |
| cmd_update->msduq_update_mask, |
| cmd_update->qdepth_thresh_value); |
| cmd_update++; |
| } |
| |
| wmi_mtrace(WMI_PEER_TID_MSDUQ_QDEPTH_THRESH_UPDATE_CMDID, |
| cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_TID_MSDUQ_QDEPTH_THRESH_UPDATE_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE(" %s :WMI Failed\n", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_vap_dscp_tid_map_cmd_tlv() - send vap dscp tid map cmd to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold vap dscp tid map param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS |
| send_set_vap_dscp_tid_map_cmd_tlv(wmi_unified_t wmi_handle, |
| struct vap_dscp_tid_map_params *param) |
| { |
| wmi_buf_t buf; |
| wmi_vdev_set_dscp_tid_map_cmd_fixed_param *cmd; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_vdev_set_dscp_tid_map_cmd_fixed_param *)wmi_buf_data(buf); |
| qdf_mem_copy(cmd->dscp_to_tid_map, param->dscp_to_tid_map, |
| sizeof(uint32_t) * WMI_DSCP_MAP_MAX); |
| |
| cmd->vdev_id = param->vdev_id; |
| cmd->enable_override = 0; |
| |
| WMI_LOGI("Setting dscp for vap id: %d\n", cmd->vdev_id); |
| wmi_mtrace(WMI_VDEV_SET_DSCP_TID_MAP_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SET_DSCP_TID_MAP_CMDID)) { |
| WMI_LOGE("Failed to set dscp cmd\n"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_vdev_set_neighbour_rx_cmd_tlv() - set neighbour rx param in fw |
| * @wmi_handle: wmi handle |
| * @macaddr: vdev mac address |
| * @param: pointer to hold neigbour rx param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_vdev_set_neighbour_rx_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct set_neighbour_rx_params *param) |
| { |
| wmi_vdev_filter_nrp_config_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd = (wmi_vdev_filter_nrp_config_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_filter_nrp_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_filter_nrp_config_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| cmd->bssid_idx = param->idx; |
| cmd->action = param->action; |
| cmd->type = param->type; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->addr); |
| cmd->flag = 0; |
| |
| wmi_mtrace(WMI_VDEV_FILTER_NEIGHBOR_RX_PACKETS_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_FILTER_NEIGHBOR_RX_PACKETS_CMDID)) { |
| WMI_LOGE("Failed to set neighbour rx param\n"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_smart_ant_set_tx_ant_cmd_tlv() - WMI set tx antenna function |
| * @param wmi_handle : handle to WMI. |
| * @param macaddr : vdev mac address |
| * @param param : pointer to tx antenna param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_smart_ant_set_tx_ant_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct smart_ant_tx_ant_params *param) |
| { |
| wmi_peer_smart_ant_set_tx_antenna_cmd_fixed_param *cmd; |
| wmi_peer_smart_ant_set_tx_antenna_series *ant_tx_series; |
| wmi_buf_t buf; |
| int32_t len = 0; |
| int i; |
| uint8_t *buf_ptr; |
| QDF_STATUS ret; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += (WMI_SMART_ANT_MAX_RATE_SERIES) * |
| sizeof(wmi_peer_smart_ant_set_tx_antenna_series); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_peer_smart_ant_set_tx_antenna_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_smart_ant_set_tx_antenna_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_smart_ant_set_tx_antenna_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| |
| buf_ptr += sizeof(wmi_peer_smart_ant_set_tx_antenna_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_peer_smart_ant_set_tx_antenna_series)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| ant_tx_series = (wmi_peer_smart_ant_set_tx_antenna_series *)buf_ptr; |
| |
| for (i = 0; i < WMI_SMART_ANT_MAX_RATE_SERIES; i++) { |
| WMITLV_SET_HDR(&ant_tx_series->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_smart_ant_set_tx_antenna_series, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_smart_ant_set_tx_antenna_series)); |
| ant_tx_series->antenna_series = param->antenna_array[i]; |
| ant_tx_series++; |
| } |
| |
| wmi_mtrace(WMI_PEER_SMART_ANT_SET_TX_ANTENNA_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, |
| len, |
| WMI_PEER_SMART_ANT_SET_TX_ANTENNA_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE(" %s :WMI Failed\n", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_ant_switch_tbl_cmd_tlv() - send ant switch tbl cmd to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold ant switch tbl param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS |
| send_set_ant_switch_tbl_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ant_switch_tbl_params *param) |
| { |
| uint8_t len; |
| wmi_buf_t buf; |
| wmi_pdev_set_ant_switch_tbl_cmd_fixed_param *cmd; |
| wmi_pdev_set_ant_ctrl_chain *ctrl_chain; |
| uint8_t *buf_ptr; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += sizeof(wmi_pdev_set_ant_ctrl_chain); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_pdev_set_ant_switch_tbl_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_ant_switch_tbl_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_set_ant_switch_tbl_cmd_fixed_param)); |
| |
| cmd->antCtrlCommon1 = param->ant_ctrl_common1; |
| cmd->antCtrlCommon2 = param->ant_ctrl_common2; |
| cmd->mac_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target(param->pdev_id); |
| |
| /* TLV indicating array of structures to follow */ |
| buf_ptr += sizeof(wmi_pdev_set_ant_switch_tbl_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_pdev_set_ant_ctrl_chain)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| ctrl_chain = (wmi_pdev_set_ant_ctrl_chain *)buf_ptr; |
| |
| ctrl_chain->pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target(param->pdev_id); |
| ctrl_chain->antCtrlChain = param->antCtrlChain; |
| |
| wmi_mtrace(WMI_PDEV_SET_ANTENNA_SWITCH_TABLE_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_ANTENNA_SWITCH_TABLE_CMDID)) { |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_smart_ant_set_training_info_cmd_tlv() - WMI set smart antenna |
| * training information function |
| * @param wmi_handle : handle to WMI. |
| * @macaddr : vdev mac address |
| * @param param : pointer to tx antenna param |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_smart_ant_set_training_info_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct smart_ant_training_info_params *param) |
| { |
| wmi_peer_smart_ant_set_train_antenna_cmd_fixed_param *cmd; |
| wmi_peer_smart_ant_set_train_antenna_param *train_param; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t len = 0; |
| QDF_STATUS ret; |
| int loop; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += (WMI_SMART_ANT_MAX_RATE_SERIES) * |
| sizeof(wmi_peer_smart_ant_set_train_antenna_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| qdf_mem_zero(buf_ptr, len); |
| cmd = (wmi_peer_smart_ant_set_train_antenna_cmd_fixed_param *)buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_smart_ant_set_train_antenna_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_smart_ant_set_train_antenna_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| cmd->num_pkts = param->numpkts; |
| |
| buf_ptr += sizeof(wmi_peer_smart_ant_set_train_antenna_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_peer_smart_ant_set_train_antenna_param) * |
| WMI_SMART_ANT_MAX_RATE_SERIES); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| train_param = (wmi_peer_smart_ant_set_train_antenna_param *)buf_ptr; |
| |
| for (loop = 0; loop < WMI_SMART_ANT_MAX_RATE_SERIES; loop++) { |
| WMITLV_SET_HDR(&train_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_smart_ant_set_train_antenna_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_smart_ant_set_train_antenna_param)); |
| train_param->train_rate_series = param->rate_array[loop]; |
| train_param->train_antenna_series = param->antenna_array[loop]; |
| train_param->rc_flags = 0; |
| WMI_LOGI(FL("Series number:%d\n"), loop); |
| WMI_LOGI(FL("Rate [0x%02x] Tx_Antenna [0x%08x]\n"), |
| train_param->train_rate_series, |
| train_param->train_antenna_series); |
| train_param++; |
| } |
| |
| wmi_mtrace(WMI_PEER_SMART_ANT_SET_TRAIN_INFO_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, |
| len, |
| WMI_PEER_SMART_ANT_SET_TRAIN_INFO_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE(" %s :WMI Failed\n", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_smart_ant_set_node_config_cmd_tlv() - WMI set node |
| * configuration function |
| * @param wmi_handle : handle to WMI. |
| * @macaddr : vdev mad address |
| * @param param : pointer to tx antenna param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_smart_ant_set_node_config_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct smart_ant_node_config_params *param) |
| { |
| wmi_peer_smart_ant_set_node_config_ops_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t len = 0, args_tlv_len; |
| int ret; |
| int i = 0; |
| uint32_t *node_config_args; |
| |
| args_tlv_len = WMI_TLV_HDR_SIZE + param->args_count * sizeof(uint32_t); |
| len = sizeof(*cmd) + args_tlv_len; |
| |
| if (param->args_count == 0) { |
| WMI_LOGE("%s: Can't send a command with %d arguments\n", |
| __func__, param->args_count); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_peer_smart_ant_set_node_config_ops_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| buf_ptr = (uint8_t *)cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_smart_ant_set_node_config_ops_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_smart_ant_set_node_config_ops_cmd_fixed_param)); |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| cmd->cmd_id = param->cmd_id; |
| cmd->args_count = param->args_count; |
| buf_ptr += sizeof( |
| wmi_peer_smart_ant_set_node_config_ops_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (cmd->args_count * sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| node_config_args = (uint32_t *)buf_ptr; |
| |
| for (i = 0; i < param->args_count; i++) { |
| node_config_args[i] = param->args_arr[i]; |
| WMI_LOGI("%d", param->args_arr[i]); |
| } |
| |
| wmi_mtrace(WMI_PEER_SMART_ANT_SET_NODE_CONFIG_OPS_CMDID, |
| cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, |
| len, |
| WMI_PEER_SMART_ANT_SET_NODE_CONFIG_OPS_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("%s: WMI FAILED:Sent cmd_id: 0x%x\n Node: %02x:%02x:%02x:%02x:%02x:%02x cmdstatus=%d\n", |
| __func__, param->cmd_id, macaddr[0], |
| macaddr[1], macaddr[2], macaddr[3], |
| macaddr[4], macaddr[5], ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| #ifdef WLAN_ATF_ENABLE |
| /** |
| * send_set_atf_cmd_tlv() - send set atf command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to set atf param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS |
| send_set_atf_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_atf_params *param) |
| { |
| wmi_atf_peer_info *peer_info; |
| wmi_peer_atf_request_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int i; |
| int32_t len = 0; |
| QDF_STATUS retval; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += param->num_peers * sizeof(wmi_atf_peer_info); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_peer_atf_request_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_atf_request_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_atf_request_fixed_param)); |
| cmd->num_peers = param->num_peers; |
| |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_atf_peer_info) * |
| cmd->num_peers); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| peer_info = (wmi_atf_peer_info *)buf_ptr; |
| |
| for (i = 0; i < cmd->num_peers; i++) { |
| WMITLV_SET_HDR(&peer_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_atf_peer_info, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_atf_peer_info)); |
| qdf_mem_copy(&(peer_info->peer_macaddr), |
| &(param->peer_info[i].peer_macaddr), |
| sizeof(wmi_mac_addr)); |
| peer_info->atf_units = param->peer_info[i].percentage_peer; |
| peer_info->vdev_id = param->peer_info[i].vdev_id; |
| peer_info->pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->peer_info[i].pdev_id); |
| /* |
| * TLV definition for peer atf request fixed param combines |
| * extension stats. Legacy FW for WIN (Non-TLV) has peer atf |
| * stats and atf extension stats as two different |
| * implementations. |
| * Need to discuss with FW on this. |
| * |
| * peer_info->atf_groupid = param->peer_ext_info[i].group_index; |
| * peer_info->atf_units_reserved = |
| * param->peer_ext_info[i].atf_index_reserved; |
| */ |
| peer_info++; |
| } |
| |
| wmi_mtrace(WMI_PEER_ATF_REQUEST_CMDID, NO_SESSION, 0); |
| retval = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_ATF_REQUEST_CMDID); |
| |
| if (retval != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s : WMI Failed\n", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| return retval; |
| } |
| #endif |
| |
| /** |
| * send_vdev_set_fwtest_param_cmd_tlv() - send fwtest param in fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold fwtest param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_vdev_set_fwtest_param_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_fwtest_params *param) |
| { |
| wmi_fwtest_set_param_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_fwtest_set_param_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_fwtest_set_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_fwtest_set_param_cmd_fixed_param)); |
| cmd->param_id = param->arg; |
| cmd->param_value = param->value; |
| |
| wmi_mtrace(WMI_FWTEST_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_FWTEST_CMDID)) { |
| WMI_LOGE("Setting FW test param failed\n"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * 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[IEEE80211_ADDR_LEN], |
| 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\n", __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\n"); |
| 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\n", __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\n"); |
| 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\n", __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\n"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| |
| } |
| |
| /** |
| * send_phyerr_disable_cmd_tlv() - WMI phyerr disable function |
| * |
| * @param wmi_handle : handle to WMI. |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_phyerr_disable_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_pdev_dfs_disable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_pdev_dfs_disable_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_dfs_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_dfs_disable_cmd_fixed_param)); |
| /* Filling it with WMI_PDEV_ID_SOC for now */ |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| |
| wmi_mtrace(WMI_PDEV_DFS_DISABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd), |
| WMI_PDEV_DFS_DISABLE_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("Sending PDEV DFS disable cmd failed\n"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_phyerr_enable_cmd_tlv() - WMI phyerr disable function |
| * |
| * @param wmi_handle : handle to WMI. |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_phyerr_enable_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_pdev_dfs_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_pdev_dfs_enable_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_dfs_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_dfs_enable_cmd_fixed_param)); |
| /* Reserved for future use */ |
| cmd->reserved0 = 0; |
| |
| wmi_mtrace(WMI_PDEV_DFS_ENABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd), |
| WMI_PDEV_DFS_ENABLE_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("Sending PDEV DFS enable cmd failed\n"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_periodic_chan_stats_config_cmd_tlv() - send periodic chan stats cmd |
| * to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold periodic chan stats param |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| send_periodic_chan_stats_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct periodic_chan_stats_params *param) |
| { |
| wmi_set_periodic_channel_stats_config_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_set_periodic_channel_stats_config_fixed_param *) |
| wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_set_periodic_channel_stats_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_set_periodic_channel_stats_config_fixed_param)); |
| cmd->enable = param->enable; |
| cmd->stats_period = param->stats_period; |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| |
| wmi_mtrace(WMI_SET_PERIODIC_CHANNEL_STATS_CONFIG_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd), |
| WMI_SET_PERIODIC_CHANNEL_STATS_CONFIG_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("Sending periodic chan stats config failed"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * 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(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\n"); |
| 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\n", __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\n"); |
| 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\n", __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\n"); |
| 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\n", __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_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\n"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_set_bwf_cmd_tlv() - send set bwf command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to set bwf param |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| send_set_bwf_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_bwf_params *param) |
| { |
| wmi_bwf_peer_info *peer_info; |
| wmi_peer_bwf_request_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS retval; |
| int32_t len; |
| uint8_t *buf_ptr; |
| int i; |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| len += param->num_peers * sizeof(wmi_bwf_peer_info); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| buf_ptr = (uint8_t *)wmi_buf_data(buf); |
| cmd = (wmi_peer_bwf_request_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_peer_bwf_request_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_peer_bwf_request_fixed_param)); |
| cmd->num_peers = param->num_peers; |
| |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_bwf_peer_info) * |
| cmd->num_peers); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| peer_info = (wmi_bwf_peer_info *)buf_ptr; |
| |
| for (i = 0; i < cmd->num_peers; i++) { |
| WMITLV_SET_HDR(&peer_info->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bwf_peer_info, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_bwf_peer_info)); |
| peer_info->bwf_guaranteed_bandwidth = |
| param->peer_info[i].throughput; |
| peer_info->bwf_max_airtime = |
| param->peer_info[i].max_airtime; |
| peer_info->bwf_peer_priority = |
| param->peer_info[i].priority; |
| qdf_mem_copy(&peer_info->peer_macaddr, |
| ¶m->peer_info[i].peer_macaddr, |
| sizeof(param->peer_info[i].peer_macaddr)); |
| peer_info->vdev_id = |
| param->peer_info[i].vdev_id; |
| peer_info->pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->peer_info[i].pdev_id); |
| peer_info++; |
| } |
| |
| wmi_mtrace(WMI_PEER_BWF_REQUEST_CMDID, NO_SESSION, 0); |
| retval = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PEER_BWF_REQUEST_CMDID); |
| |
| if (retval != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s : WMI Failed\n", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| return retval; |
| } |
| |
| /** |
| * 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\n", __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\n", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_vdev_spectral_configure_cmd_tlv() - send VDEV spectral configure |
| * command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold spectral config parameter |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS send_vdev_spectral_configure_cmd_tlv(wmi_unified_t wmi_handle, |
| struct vdev_spectral_configure_params *param) |
| { |
| wmi_vdev_spectral_configure_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_vdev_spectral_configure_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_spectral_configure_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_spectral_configure_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| cmd->spectral_scan_count = param->count; |
| cmd->spectral_scan_period = param->period; |
| cmd->spectral_scan_priority = param->spectral_pri; |
| cmd->spectral_scan_fft_size = param->fft_size; |
| cmd->spectral_scan_gc_ena = param->gc_enable; |
| cmd->spectral_scan_restart_ena = param->restart_enable; |
| cmd->spectral_scan_noise_floor_ref = param->noise_floor_ref; |
| cmd->spectral_scan_init_delay = param->init_delay; |
| cmd->spectral_scan_nb_tone_thr = param->nb_tone_thr; |
| cmd->spectral_scan_str_bin_thr = param->str_bin_thr; |
| cmd->spectral_scan_wb_rpt_mode = param->wb_rpt_mode; |
| cmd->spectral_scan_rssi_rpt_mode = param->rssi_rpt_mode; |
| cmd->spectral_scan_rssi_thr = param->rssi_thr; |
| cmd->spectral_scan_pwr_format = param->pwr_format; |
| cmd->spectral_scan_rpt_mode = param->rpt_mode; |
| cmd->spectral_scan_bin_scale = param->bin_scale; |
| cmd->spectral_scan_dBm_adj = param->dbm_adj; |
| cmd->spectral_scan_chn_mask = param->chn_mask; |
| |
| wmi_mtrace(WMI_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("Sending set quiet cmd failed\n"); |
| wmi_buf_free(buf); |
| } |
| |
| WMI_LOGI("%s: Sent WMI_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID\n", |
| __func__); |
| |
| WMI_LOGI("vdev_id = %u\n" |
| "spectral_scan_count = %u\n" |
| "spectral_scan_period = %u\n" |
| "spectral_scan_priority = %u\n" |
| "spectral_scan_fft_size = %u\n" |
| "spectral_scan_gc_ena = %u\n" |
| "spectral_scan_restart_ena = %u\n" |
| "spectral_scan_noise_floor_ref = %u\n" |
| "spectral_scan_init_delay = %u\n" |
| "spectral_scan_nb_tone_thr = %u\n" |
| "spectral_scan_str_bin_thr = %u\n" |
| "spectral_scan_wb_rpt_mode = %u\n" |
| "spectral_scan_rssi_rpt_mode = %u\n" |
| "spectral_scan_rssi_thr = %u\n" |
| "spectral_scan_pwr_format = %u\n" |
| "spectral_scan_rpt_mode = %u\n" |
| "spectral_scan_bin_scale = %u\n" |
| "spectral_scan_dBm_adj = %u\n" |
| "spectral_scan_chn_mask = %u\n", |
| param->vdev_id, |
| param->count, |
| param->period, |
| param->spectral_pri, |
| param->fft_size, |
| param->gc_enable, |
| param->restart_enable, |
| param->noise_floor_ref, |
| param->init_delay, |
| param->nb_tone_thr, |
| param->str_bin_thr, |
| param->wb_rpt_mode, |
| param->rssi_rpt_mode, |
| param->rssi_thr, |
| param->pwr_format, |
| param->rpt_mode, |
| param->bin_scale, |
| param->dbm_adj, |
| param->chn_mask); |
| WMI_LOGI("%s: Status: %d\n\n", __func__, ret); |
| |
| return ret; |
| } |
| |
| /** |
| * send_vdev_spectral_enable_cmd_tlv() - send VDEV spectral configure |
| * command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold spectral enable parameter |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS send_vdev_spectral_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| struct vdev_spectral_enable_params *param) |
| { |
| wmi_vdev_spectral_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_vdev_spectral_enable_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_spectral_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_spectral_enable_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| |
| if (param->active_valid) { |
| cmd->trigger_cmd = param->active ? 1 : 2; |
| /* 1: Trigger, 2: Clear Trigger */ |
| } else { |
| cmd->trigger_cmd = 0; /* 0: Ignore */ |
| } |
| |
| if (param->enabled_valid) { |
| cmd->enable_cmd = param->enabled ? 1 : 2; |
| /* 1: Enable 2: Disable */ |
| } else { |
| cmd->enable_cmd = 0; /* 0: Ignore */ |
| } |
| |
| wmi_mtrace(WMI_VDEV_SPECTRAL_SCAN_ENABLE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_VDEV_SPECTRAL_SCAN_ENABLE_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("Sending scan enable CMD failed\n"); |
| wmi_buf_free(buf); |
| } |
| |
| WMI_LOGI("%s: Sent WMI_VDEV_SPECTRAL_SCAN_ENABLE_CMDID\n", __func__); |
| |
| WMI_LOGI("vdev_id = %u\n" |
| "trigger_cmd = %u\n" |
| "enable_cmd = %u\n", |
| cmd->vdev_id, |
| cmd->trigger_cmd, |
| cmd->enable_cmd); |
| |
| WMI_LOGI("%s: Status: %d\n\n", __func__, ret); |
| |
| return ret; |
| } |
| |
| /** |
| * send_thermal_mitigation_param_cmd_tlv() - configure thermal mitigation params |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold thermal mitigation param |
| * |
| * @return QDF_STATUS_SUCCESS on success and -ve on failure. |
| */ |
| static QDF_STATUS send_thermal_mitigation_param_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| struct thermal_mitigation_params *param) |
| { |
| wmi_therm_throt_config_request_fixed_param *tt_conf = NULL; |
| wmi_therm_throt_level_config_info *lvl_conf = NULL; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr = NULL; |
| int error; |
| int32_t len; |
| int i; |
| |
| len = sizeof(*tt_conf) + WMI_TLV_HDR_SIZE + |
| THERMAL_LEVELS * sizeof(wmi_therm_throt_level_config_info); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| tt_conf = (wmi_therm_throt_config_request_fixed_param *) wmi_buf_data(buf); |
| |
| /* init fixed params */ |
| WMITLV_SET_HDR(tt_conf, |
| WMITLV_TAG_STRUC_wmi_therm_throt_config_request_fixed_param, |
| (WMITLV_GET_STRUCT_TLVLEN(wmi_therm_throt_config_request_fixed_param))); |
| |
| tt_conf->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| tt_conf->enable = param->enable; |
| tt_conf->dc = param->dc; |
| tt_conf->dc_per_event = param->dc_per_event; |
| tt_conf->therm_throt_levels = THERMAL_LEVELS; |
| |
| buf_ptr = (uint8_t *) ++tt_conf; |
| /* init TLV params */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (THERMAL_LEVELS * sizeof(wmi_therm_throt_level_config_info))); |
| |
| lvl_conf = (wmi_therm_throt_level_config_info *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < THERMAL_LEVELS; i++) { |
| WMITLV_SET_HDR(&lvl_conf->tlv_header, |
| WMITLV_TAG_STRUC_wmi_therm_throt_level_config_info, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_therm_throt_level_config_info)); |
| lvl_conf->temp_lwm = param->levelconf[i].tmplwm; |
| lvl_conf->temp_hwm = param->levelconf[i].tmphwm; |
| lvl_conf->dc_off_percent = param->levelconf[i].dcoffpercent; |
| lvl_conf->prio = param->levelconf[i].priority; |
| lvl_conf++; |
| } |
| |
| wmi_mtrace(WMI_THERM_THROT_SET_CONF_CMDID, NO_SESSION, 0); |
| error = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_THERM_THROT_SET_CONF_CMDID); |
| if (QDF_IS_STATUS_ERROR(error)) { |
| wmi_buf_free(buf); |
| WMI_LOGE("Failed to send WMI_THERM_THROT_SET_CONF_CMDID command"); |
| } |
| |
| return error; |
| } |
| |
| /** |
| * 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\n", __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\n"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_coex_config_cmd_tlv() - send coex config command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to coex config param |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| send_coex_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct coex_config_params *param) |
| { |
| WMI_COEX_CONFIG_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS ret; |
| int32_t len; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (WMI_COEX_CONFIG_CMD_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_COEX_CONFIG_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| WMI_COEX_CONFIG_CMD_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| cmd->config_type = param->config_type; |
| cmd->config_arg1 = param->config_arg1; |
| cmd->config_arg2 = param->config_arg2; |
| cmd->config_arg3 = param->config_arg3; |
| cmd->config_arg4 = param->config_arg4; |
| cmd->config_arg5 = param->config_arg5; |
| cmd->config_arg6 = param->config_arg6; |
| |
| wmi_mtrace(WMI_COEX_CONFIG_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_COEX_CONFIG_CMDID); |
| |
| if (ret != 0) { |
| WMI_LOGE("Sending COEX CONFIG CMD failed\n"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| |
| #ifdef WLAN_SUPPORT_TWT |
| static void wmi_copy_twt_resource_config(wmi_resource_config *resource_cfg, |
| target_resource_config *tgt_res_cfg) |
| { |
| resource_cfg->twt_ap_pdev_count = tgt_res_cfg->twt_ap_pdev_count; |
| resource_cfg->twt_ap_sta_count = tgt_res_cfg->twt_ap_sta_count; |
| } |
| #else |
| static void wmi_copy_twt_resource_config(wmi_resource_config *resource_cfg, |
| target_resource_config *tgt_res_cfg) |
| { |
| resource_cfg->twt_ap_pdev_count = 0; |
| resource_cfg->twt_ap_sta_count = 0; |
| } |
| #endif |
| |
| static |
| void wmi_copy_resource_config(wmi_resource_config *resource_cfg, |
| target_resource_config *tgt_res_cfg) |
| { |
| resource_cfg->num_vdevs = tgt_res_cfg->num_vdevs; |
| resource_cfg->num_peers = tgt_res_cfg->num_peers; |
| resource_cfg->num_offload_peers = tgt_res_cfg->num_offload_peers; |
| resource_cfg->num_offload_reorder_buffs = |
| tgt_res_cfg->num_offload_reorder_buffs; |
| resource_cfg->num_peer_keys = tgt_res_cfg->num_peer_keys; |
| resource_cfg->num_tids = tgt_res_cfg->num_tids; |
| resource_cfg->ast_skid_limit = tgt_res_cfg->ast_skid_limit; |
| resource_cfg->tx_chain_mask = tgt_res_cfg->tx_chain_mask; |
| resource_cfg->rx_chain_mask = tgt_res_cfg->rx_chain_mask; |
| resource_cfg->rx_timeout_pri[0] = tgt_res_cfg->rx_timeout_pri[0]; |
| resource_cfg->rx_timeout_pri[1] = tgt_res_cfg->rx_timeout_pri[1]; |
| resource_cfg->rx_timeout_pri[2] = tgt_res_cfg->rx_timeout_pri[2]; |
| resource_cfg->rx_timeout_pri[3] = tgt_res_cfg->rx_timeout_pri[3]; |
| resource_cfg->rx_decap_mode = tgt_res_cfg->rx_decap_mode; |
| resource_cfg->scan_max_pending_req = |
| tgt_res_cfg->scan_max_pending_req; |
| resource_cfg->bmiss_offload_max_vdev = |
| tgt_res_cfg->bmiss_offload_max_vdev; |
| resource_cfg->roam_offload_max_vdev = |
| tgt_res_cfg->roam_offload_max_vdev; |
| resource_cfg->roam_offload_max_ap_profiles = |
| tgt_res_cfg->roam_offload_max_ap_profiles; |
| resource_cfg->num_mcast_groups = tgt_res_cfg->num_mcast_groups; |
| resource_cfg->num_mcast_table_elems = |
| tgt_res_cfg->num_mcast_table_elems; |
| resource_cfg->mcast2ucast_mode = tgt_res_cfg->mcast2ucast_mode; |
| resource_cfg->tx_dbg_log_size = tgt_res_cfg->tx_dbg_log_size; |
| resource_cfg->num_wds_entries = tgt_res_cfg->num_wds_entries; |
| resource_cfg->dma_burst_size = tgt_res_cfg->dma_burst_size; |
| resource_cfg->mac_aggr_delim = tgt_res_cfg->mac_aggr_delim; |
| resource_cfg->rx_skip_defrag_timeout_dup_detection_check = |
| tgt_res_cfg->rx_skip_defrag_timeout_dup_detection_check; |
| resource_cfg->vow_config = tgt_res_cfg->vow_config; |
| resource_cfg->gtk_offload_max_vdev = tgt_res_cfg->gtk_offload_max_vdev; |
| resource_cfg->num_msdu_desc = tgt_res_cfg->num_msdu_desc; |
| resource_cfg->max_frag_entries = tgt_res_cfg->max_frag_entries; |
| resource_cfg->num_tdls_vdevs = tgt_res_cfg->num_tdls_vdevs; |
| resource_cfg->num_tdls_conn_table_entries = |
| tgt_res_cfg->num_tdls_conn_table_entries; |
| resource_cfg->beacon_tx_offload_max_vdev = |
| tgt_res_cfg->beacon_tx_offload_max_vdev; |
| resource_cfg->num_multicast_filter_entries = |
| tgt_res_cfg->num_multicast_filter_entries; |
| resource_cfg->num_wow_filters = |
| tgt_res_cfg->num_wow_filters; |
| resource_cfg->num_keep_alive_pattern = |
| tgt_res_cfg->num_keep_alive_pattern; |
| resource_cfg->keep_alive_pattern_size = |
| tgt_res_cfg->keep_alive_pattern_size; |
| resource_cfg->max_tdls_concurrent_sleep_sta = |
| tgt_res_cfg->max_tdls_concurrent_sleep_sta; |
| resource_cfg->max_tdls_concurrent_buffer_sta = |
| tgt_res_cfg->max_tdls_concurrent_buffer_sta; |
| resource_cfg->wmi_send_separate = |
| tgt_res_cfg->wmi_send_separate; |
| resource_cfg->num_ocb_vdevs = |
| tgt_res_cfg->num_ocb_vdevs; |
| resource_cfg->num_ocb_channels = |
| tgt_res_cfg->num_ocb_channels; |
| resource_cfg->num_ocb_schedules = |
| tgt_res_cfg->num_ocb_schedules; |
| resource_cfg->bpf_instruction_size = tgt_res_cfg->apf_instruction_size; |
| resource_cfg->max_bssid_rx_filters = tgt_res_cfg->max_bssid_rx_filters; |
| resource_cfg->use_pdev_id = tgt_res_cfg->use_pdev_id; |
| resource_cfg->max_num_dbs_scan_duty_cycle = |
| tgt_res_cfg->max_num_dbs_scan_duty_cycle; |
| resource_cfg->sched_params = tgt_res_cfg->scheduler_params; |
| resource_cfg->num_packet_filters = tgt_res_cfg->num_packet_filters; |
| resource_cfg->num_max_sta_vdevs = tgt_res_cfg->num_max_sta_vdevs; |
| resource_cfg->max_bssid_indicator = tgt_res_cfg->max_bssid_indicator; |
| if (tgt_res_cfg->atf_config) |
| WMI_RSRC_CFG_FLAG_ATF_CONFIG_ENABLE_SET(resource_cfg->flag1, 1); |
| if (tgt_res_cfg->mgmt_comp_evt_bundle_support) |
| WMI_RSRC_CFG_FLAG_MGMT_COMP_EVT_BUNDLE_SUPPORT_SET( |
| resource_cfg->flag1, 1); |
| if (tgt_res_cfg->tx_msdu_new_partition_id_support) |
| WMI_RSRC_CFG_FLAG_TX_MSDU_ID_NEW_PARTITION_SUPPORT_SET( |
| resource_cfg->flag1, 1); |
| if (tgt_res_cfg->cce_disable) |
| WMI_RSRC_CFG_FLAG_TCL_CCE_DISABLE_SET(resource_cfg->flag1, 1); |
| |
| wmi_copy_twt_resource_config(resource_cfg, tgt_res_cfg); |
| resource_cfg->peer_map_unmap_v2_support = |
| tgt_res_cfg->peer_map_unmap_v2; |
| } |
| |
| /* copy_hw_mode_id_in_init_cmd() - Helper routine to copy hw_mode in init cmd |
| * @wmi_handle: pointer to wmi handle |
| * @buf_ptr: pointer to current position in init command buffer |
| * @len: pointer to length. This will be updated with current length of cmd |
| * @param: point host parameters for init command |
| * |
| * Return: Updated pointer of buf_ptr. |
| */ |
| static inline uint8_t *copy_hw_mode_in_init_cmd(struct wmi_unified *wmi_handle, |
| uint8_t *buf_ptr, int *len, struct wmi_init_cmd_param *param) |
| { |
| uint16_t idx; |
| |
| if (param->hw_mode_id != WMI_HOST_HW_MODE_MAX) { |
| wmi_pdev_set_hw_mode_cmd_fixed_param *hw_mode; |
| wmi_pdev_band_to_mac *band_to_mac; |
| |
| hw_mode = (wmi_pdev_set_hw_mode_cmd_fixed_param *) |
| (buf_ptr + sizeof(wmi_init_cmd_fixed_param) + |
| sizeof(wmi_resource_config) + |
| WMI_TLV_HDR_SIZE + (param->num_mem_chunks * |
| sizeof(wlan_host_memory_chunk))); |
| |
| WMITLV_SET_HDR(&hw_mode->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_hw_mode_cmd_fixed_param, |
| (WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_set_hw_mode_cmd_fixed_param))); |
| |
| hw_mode->hw_mode_index = param->hw_mode_id; |
| hw_mode->num_band_to_mac = param->num_band_to_mac; |
| |
| buf_ptr = (uint8_t *) (hw_mode + 1); |
| band_to_mac = (wmi_pdev_band_to_mac *) (buf_ptr + |
| WMI_TLV_HDR_SIZE); |
| for (idx = 0; idx < param->num_band_to_mac; idx++) { |
| WMITLV_SET_HDR(&band_to_mac[idx].tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_band_to_mac, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_band_to_mac)); |
| band_to_mac[idx].pdev_id = |
| wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->band_to_mac[idx].pdev_id); |
| band_to_mac[idx].start_freq = |
| param->band_to_mac[idx].start_freq; |
| band_to_mac[idx].end_freq = |
| param->band_to_mac[idx].end_freq; |
| } |
| *len += sizeof(wmi_pdev_set_hw_mode_cmd_fixed_param) + |
| (param->num_band_to_mac * |
| sizeof(wmi_pdev_band_to_mac)) + |
| WMI_TLV_HDR_SIZE; |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (param->num_band_to_mac * |
| sizeof(wmi_pdev_band_to_mac))); |
| } |
| |
| return buf_ptr; |
| } |
| |
| static inline void copy_fw_abi_version_tlv(wmi_unified_t wmi_handle, |
| wmi_init_cmd_fixed_param *cmd) |
| { |
| int num_whitelist; |
| wmi_abi_version my_vers; |
| |
| num_whitelist = sizeof(version_whitelist) / |
| sizeof(wmi_whitelist_version_info); |
| my_vers.abi_version_0 = WMI_ABI_VERSION_0; |
| my_vers.abi_version_1 = WMI_ABI_VERSION_1; |
| my_vers.abi_version_ns_0 = WMI_ABI_VERSION_NS_0; |
| my_vers.abi_version_ns_1 = WMI_ABI_VERSION_NS_1; |
| my_vers.abi_version_ns_2 = WMI_ABI_VERSION_NS_2; |
| my_vers.abi_version_ns_3 = WMI_ABI_VERSION_NS_3; |
| |
| wmi_cmp_and_set_abi_version(num_whitelist, version_whitelist, |
| &my_vers, |
| (struct _wmi_abi_version *)&wmi_handle->fw_abi_version, |
| &cmd->host_abi_vers); |
| |
| qdf_print("%s: INIT_CMD version: %d, %d, 0x%x, 0x%x, 0x%x, 0x%x", |
| __func__, |
| WMI_VER_GET_MAJOR(cmd->host_abi_vers.abi_version_0), |
| WMI_VER_GET_MINOR(cmd->host_abi_vers.abi_version_0), |
| cmd->host_abi_vers.abi_version_ns_0, |
| cmd->host_abi_vers.abi_version_ns_1, |
| cmd->host_abi_vers.abi_version_ns_2, |
| cmd->host_abi_vers.abi_version_ns_3); |
| |
| /* Save version sent from host - |
| * Will be used to check ready event |
| */ |
| qdf_mem_copy(&wmi_handle->final_abi_vers, &cmd->host_abi_vers, |
| sizeof(wmi_abi_version)); |
| } |
| |
| static QDF_STATUS save_fw_version_cmd_tlv(wmi_unified_t wmi_handle, void *evt_buf) |
| { |
| WMI_SERVICE_READY_EVENTID_param_tlvs *param_buf; |
| wmi_service_ready_event_fixed_param *ev; |
| |
| |
| param_buf = (WMI_SERVICE_READY_EVENTID_param_tlvs *) evt_buf; |
| |
| ev = (wmi_service_ready_event_fixed_param *) param_buf->fixed_param; |
| if (!ev) |
| return QDF_STATUS_E_FAILURE; |
| |
| /*Save fw version from service ready message */ |
| /*This will be used while sending INIT message */ |
| qdf_mem_copy(&wmi_handle->fw_abi_version, &ev->fw_abi_vers, |
| sizeof(wmi_handle->fw_abi_version)); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * wmi_unified_save_fw_version_cmd() - save fw version |
| * @wmi_handle: pointer to wmi handle |
| * @res_cfg: resource config |
| * @num_mem_chunks: no of mem chunck |
| * @mem_chunk: pointer to mem chunck structure |
| * |
| * This function sends IE information to firmware |
| * |
| * Return: QDF_STATUS_SUCCESS for success otherwise failure |
| * |
| */ |
| static QDF_STATUS check_and_update_fw_version_cmd_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf) |
| { |
| WMI_READY_EVENTID_param_tlvs *param_buf = NULL; |
| wmi_ready_event_fixed_param *ev = NULL; |
| |
| param_buf = (WMI_READY_EVENTID_param_tlvs *) evt_buf; |
| ev = param_buf->fixed_param; |
| if (!wmi_versions_are_compatible((struct _wmi_abi_version *) |
| &wmi_handle->final_abi_vers, |
| &ev->fw_abi_vers)) { |
| /* |
| * Error: Our host version and the given firmware version |
| * are incompatible. |
| **/ |
| WMI_LOGD("%s: Error: Incompatible WMI version." |
| "Host: %d,%d,0x%x 0x%x 0x%x 0x%x, FW: %d,%d,0x%x 0x%x 0x%x 0x%x\n", |
| __func__, |
| WMI_VER_GET_MAJOR(wmi_handle->final_abi_vers. |
| abi_version_0), |
| WMI_VER_GET_MINOR(wmi_handle->final_abi_vers. |
| abi_version_0), |
| wmi_handle->final_abi_vers.abi_version_ns_0, |
| wmi_handle->final_abi_vers.abi_version_ns_1, |
| wmi_handle->final_abi_vers.abi_version_ns_2, |
| wmi_handle->final_abi_vers.abi_version_ns_3, |
| WMI_VER_GET_MAJOR(ev->fw_abi_vers.abi_version_0), |
| WMI_VER_GET_MINOR(ev->fw_abi_vers.abi_version_0), |
| ev->fw_abi_vers.abi_version_ns_0, |
| ev->fw_abi_vers.abi_version_ns_1, |
| ev->fw_abi_vers.abi_version_ns_2, |
| ev->fw_abi_vers.abi_version_ns_3); |
| |
| return QDF_STATUS_E_FAILURE; |
| } |
| qdf_mem_copy(&wmi_handle->final_abi_vers, &ev->fw_abi_vers, |
| sizeof(wmi_abi_version)); |
| qdf_mem_copy(&wmi_handle->fw_abi_version, &ev->fw_abi_vers, |
| sizeof(wmi_abi_version)); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_set_base_macaddr_indicate_cmd_tlv() - set base mac address in fw |
| * @wmi_handle: wmi handle |
| * @custom_addr: base mac address |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_set_base_macaddr_indicate_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t *custom_addr) |
| { |
| wmi_pdev_set_base_macaddr_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| int err; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send base macaddr cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_pdev_set_base_macaddr_cmd_fixed_param *) wmi_buf_data(buf); |
| qdf_mem_zero(cmd, sizeof(*cmd)); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_base_macaddr_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_set_base_macaddr_cmd_fixed_param)); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(custom_addr, &cmd->base_macaddr); |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| wmi_mtrace(WMI_PDEV_SET_BASE_MACADDR_CMDID, NO_SESSION, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), |
| WMI_PDEV_SET_BASE_MACADDR_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send set_base_macaddr cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_log_supported_evt_cmd_tlv() - Enable/Disable FW diag/log events |
| * @handle: wmi handle |
| * @event: Event received from FW |
| * @len: Length of the event |
| * |
| * Enables the low frequency events and disables the high frequency |
| * events. Bit 17 indicates if the event if low/high frequency. |
| * 1 - high frequency, 0 - low frequency |
| * |
| * Return: 0 on successfully enabling/disabling the events |
| */ |
| static QDF_STATUS send_log_supported_evt_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t *event, |
| uint32_t len) |
| { |
| uint32_t num_of_diag_events_logs; |
| wmi_diag_event_log_config_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t *cmd_args, *evt_args; |
| uint32_t buf_len, i; |
| |
| WMI_DIAG_EVENT_LOG_SUPPORTED_EVENTID_param_tlvs *param_buf; |
| wmi_diag_event_log_supported_event_fixed_params *wmi_event; |
| |
| WMI_LOGI("Received WMI_DIAG_EVENT_LOG_SUPPORTED_EVENTID"); |
| |
| param_buf = (WMI_DIAG_EVENT_LOG_SUPPORTED_EVENTID_param_tlvs *) event; |
| if (!param_buf) { |
| WMI_LOGE("Invalid log supported event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| wmi_event = param_buf->fixed_param; |
| num_of_diag_events_logs = wmi_event->num_of_diag_events_logs; |
| |
| if (num_of_diag_events_logs > |
| param_buf->num_diag_events_logs_list) { |
| WMI_LOGE("message number of events %d is more than tlv hdr content %d", |
| num_of_diag_events_logs, |
| param_buf->num_diag_events_logs_list); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| evt_args = param_buf->diag_events_logs_list; |
| if (!evt_args) { |
| WMI_LOGE("%s: Event list is empty, num_of_diag_events_logs=%d", |
| __func__, num_of_diag_events_logs); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGD("%s: num_of_diag_events_logs=%d", |
| __func__, num_of_diag_events_logs); |
| |
| /* Free any previous allocation */ |
| if (wmi_handle->events_logs_list) |
| qdf_mem_free(wmi_handle->events_logs_list); |
| |
| if (num_of_diag_events_logs > |
| (WMI_SVC_MSG_MAX_SIZE / sizeof(uint32_t))) { |
| WMI_LOGE("%s: excess num of logs:%d", __func__, |
| num_of_diag_events_logs); |
| QDF_ASSERT(0); |
| return QDF_STATUS_E_INVAL; |
| } |
| /* Store the event list for run time enable/disable */ |
| wmi_handle->events_logs_list = qdf_mem_malloc(num_of_diag_events_logs * |
| sizeof(uint32_t)); |
| if (!wmi_handle->events_logs_list) { |
| WMI_LOGE("%s: event log list memory allocation failed", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| wmi_handle->num_of_diag_events_logs = num_of_diag_events_logs; |
| |
| /* Prepare the send buffer */ |
| buf_len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + |
| (num_of_diag_events_logs * sizeof(uint32_t)); |
| |
| buf = wmi_buf_alloc(wmi_handle, buf_len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| qdf_mem_free(wmi_handle->events_logs_list); |
| wmi_handle->events_logs_list = NULL; |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_diag_event_log_config_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_diag_event_log_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_diag_event_log_config_fixed_param)); |
| |
| cmd->num_of_diag_events_logs = num_of_diag_events_logs; |
| |
| buf_ptr += sizeof(wmi_diag_event_log_config_fixed_param); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (num_of_diag_events_logs * sizeof(uint32_t))); |
| |
| cmd_args = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| |
| /* Populate the events */ |
| for (i = 0; i < num_of_diag_events_logs; i++) { |
| /* Low freq (0) - Enable (1) the event |
| * High freq (1) - Disable (0) the event |
| */ |
| WMI_DIAG_ID_ENABLED_DISABLED_SET(cmd_args[i], |
| !(WMI_DIAG_FREQUENCY_GET(evt_args[i]))); |
| /* Set the event ID */ |
| WMI_DIAG_ID_SET(cmd_args[i], |
| WMI_DIAG_ID_GET(evt_args[i])); |
| /* Set the type */ |
| WMI_DIAG_TYPE_SET(cmd_args[i], |
| WMI_DIAG_TYPE_GET(evt_args[i])); |
| /* Storing the event/log list in WMI */ |
| wmi_handle->events_logs_list[i] = evt_args[i]; |
| } |
| |
| wmi_mtrace(WMI_DIAG_EVENT_LOG_CONFIG_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, buf_len, |
| WMI_DIAG_EVENT_LOG_CONFIG_CMDID)) { |
| WMI_LOGE("%s: WMI_DIAG_EVENT_LOG_CONFIG_CMDID failed", |
| __func__); |
| wmi_buf_free(buf); |
| /* Not clearing events_logs_list, though wmi cmd failed. |
| * Host can still have this list |
| */ |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * send_enable_specific_fw_logs_cmd_tlv() - Start/Stop logging of diag log id |
| * @wmi_handle: wmi handle |
| * @start_log: Start logging related parameters |
| * |
| * Send the command to the FW based on which specific logging of diag |
| * event/log id can be started/stopped |
| * |
| * Return: None |
| */ |
| static QDF_STATUS send_enable_specific_fw_logs_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_wifi_start_log *start_log) |
| { |
| wmi_diag_event_log_config_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len, count, log_level, i; |
| uint32_t *cmd_args; |
| uint32_t total_len; |
| count = 0; |
| |
| if (!wmi_handle->events_logs_list) { |
| WMI_LOGD("%s: Not received event/log list from FW, yet", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| /* total_len stores the number of events where BITS 17 and 18 are set. |
| * i.e., events of high frequency (17) and for extended debugging (18) |
| */ |
| total_len = 0; |
| for (i = 0; i < wmi_handle->num_of_diag_events_logs; i++) { |
| if ((WMI_DIAG_FREQUENCY_GET(wmi_handle->events_logs_list[i])) && |
| (WMI_DIAG_EXT_FEATURE_GET(wmi_handle->events_logs_list[i]))) |
| total_len++; |
| } |
| |
| len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + |
| (total_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_NOMEM; |
| } |
| cmd = (wmi_diag_event_log_config_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_diag_event_log_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_diag_event_log_config_fixed_param)); |
| |
| cmd->num_of_diag_events_logs = total_len; |
| |
| buf_ptr += sizeof(wmi_diag_event_log_config_fixed_param); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (total_len * sizeof(uint32_t))); |
| |
| cmd_args = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| |
| if (start_log->verbose_level >= WMI_LOG_LEVEL_ACTIVE) |
| log_level = 1; |
| else |
| log_level = 0; |
| |
| WMI_LOGD("%s: Length:%d, Log_level:%d", __func__, total_len, log_level); |
| for (i = 0; i < wmi_handle->num_of_diag_events_logs; i++) { |
| uint32_t val = wmi_handle->events_logs_list[i]; |
| if ((WMI_DIAG_FREQUENCY_GET(val)) && |
| (WMI_DIAG_EXT_FEATURE_GET(val))) { |
| |
| WMI_DIAG_ID_SET(cmd_args[count], |
| WMI_DIAG_ID_GET(val)); |
| WMI_DIAG_TYPE_SET(cmd_args[count], |
| WMI_DIAG_TYPE_GET(val)); |
| WMI_DIAG_ID_ENABLED_DISABLED_SET(cmd_args[count], |
| log_level); |
| WMI_LOGD("%s: Idx:%d, val:%x", __func__, i, val); |
| count++; |
| } |
| } |
| |
| wmi_mtrace(WMI_DIAG_EVENT_LOG_CONFIG_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_DIAG_EVENT_LOG_CONFIG_CMDID)) { |
| WMI_LOGE("%s: WMI_DIAG_EVENT_LOG_CONFIG_CMDID failed", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_flush_logs_to_fw_cmd_tlv() - Send log flush command to FW |
| * @wmi_handle: WMI handle |
| * |
| * This function is used to send the flush command to the FW, |
| * that will flush the fw logs that are residue in the FW |
| * |
| * Return: None |
| */ |
| static QDF_STATUS send_flush_logs_to_fw_cmd_tlv(wmi_unified_t wmi_handle) |
| { |
| wmi_debug_mesg_flush_fixed_param *cmd; |
| wmi_buf_t buf; |
| int len = sizeof(*cmd); |
| QDF_STATUS ret; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_debug_mesg_flush_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_debug_mesg_flush_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_debug_mesg_flush_fixed_param)); |
| cmd->reserved0 = 0; |
| |
| wmi_mtrace(WMI_DEBUG_MESG_FLUSH_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, |
| len, |
| WMI_DEBUG_MESG_FLUSH_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("Failed to send WMI_DEBUG_MESG_FLUSH_CMDID"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_INVAL; |
| } |
| WMI_LOGD("Sent WMI_DEBUG_MESG_FLUSH_CMDID to FW"); |
| |
| return ret; |
| } |
| |
| /** |
| * send_pdev_set_pcl_cmd_tlv() - Send WMI_SOC_SET_PCL_CMDID to FW |
| * @wmi_handle: wmi handle |
| * @msg: PCL structure containing the PCL and the number of channels |
| * |
| * WMI_PDEV_SET_PCL_CMDID provides a Preferred Channel List (PCL) to the WLAN |
| * firmware. The DBS Manager is the consumer of this information in the WLAN |
| * firmware. The channel list will be used when a Virtual DEVice (VDEV) needs |
| * to migrate to a new channel without host driver involvement. An example of |
| * this behavior is Legacy Fast Roaming (LFR 3.0). Generally, the host will |
| * manage the channel selection without firmware involvement. |
| * |
| * WMI_PDEV_SET_PCL_CMDID will carry only the weight list and not the actual |
| * channel list. The weights corresponds to the channels sent in |
| * WMI_SCAN_CHAN_LIST_CMDID. The channels from PCL would be having a higher |
| * weightage compared to the non PCL channels. |
| * |
| * Return: Success if the cmd is sent successfully to the firmware |
| */ |
| static QDF_STATUS send_pdev_set_pcl_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_pcl_chan_weights *msg) |
| { |
| wmi_pdev_set_pcl_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t *cmd_args, i, len; |
| uint32_t chan_len; |
| |
| chan_len = msg->saved_num_chan; |
| |
| len = sizeof(*cmd) + |
| WMI_TLV_HDR_SIZE + (chan_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_NOMEM; |
| } |
| |
| cmd = (wmi_pdev_set_pcl_cmd_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_pcl_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_pdev_set_pcl_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| cmd->num_chan = chan_len; |
| WMI_LOGD("%s: Total chan (PCL) len:%d", __func__, cmd->num_chan); |
| |
| buf_ptr += sizeof(wmi_pdev_set_pcl_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (chan_len * sizeof(uint32_t))); |
| cmd_args = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| for (i = 0; i < chan_len ; i++) { |
| cmd_args[i] = msg->weighed_valid_list[i]; |
| WMI_LOGD("%s: chan:%d weight:%d", __func__, |
| msg->saved_chan_list[i], cmd_args[i]); |
| } |
| wmi_mtrace(WMI_PDEV_SET_PCL_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_PCL_CMDID)) { |
| WMI_LOGE("%s: Failed to send WMI_PDEV_SET_PCL_CMDID", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_pdev_set_hw_mode_cmd_tlv() - Send WMI_PDEV_SET_HW_MODE_CMDID to FW |
| * @wmi_handle: wmi handle |
| * @msg: Structure containing the following parameters |
| * |
| * - hw_mode_index: The HW_Mode field is a enumerated type that is selected |
| * from the HW_Mode table, which is returned in the WMI_SERVICE_READY_EVENTID. |
| * |
| * Provides notification to the WLAN firmware that host driver is requesting a |
| * HardWare (HW) Mode change. This command is needed to support iHelium in the |
| * configurations that include the Dual Band Simultaneous (DBS) feature. |
| * |
| * Return: Success if the cmd is sent successfully to the firmware |
| */ |
| static QDF_STATUS send_pdev_set_hw_mode_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t hw_mode_index) |
| { |
| wmi_pdev_set_hw_mode_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint32_t len; |
| |
| len = sizeof(*cmd); |
| |
| 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_set_hw_mode_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_hw_mode_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_pdev_set_hw_mode_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| cmd->hw_mode_index = hw_mode_index; |
| WMI_LOGI("%s: HW mode index:%d", __func__, cmd->hw_mode_index); |
| |
| wmi_mtrace(WMI_PDEV_SET_HW_MODE_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_HW_MODE_CMDID)) { |
| WMI_LOGE("%s: Failed to send WMI_PDEV_SET_HW_MODE_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef WLAN_POLICY_MGR_ENABLE |
| /** |
| * send_pdev_set_dual_mac_config_cmd_tlv() - Set dual mac config to FW |
| * @wmi_handle: wmi handle |
| * @msg: Dual MAC config parameters |
| * |
| * Configures WLAN firmware with the dual MAC features |
| * |
| * Return: QDF_STATUS. 0 on success. |
| */ |
| static |
| QDF_STATUS send_pdev_set_dual_mac_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct policy_mgr_dual_mac_config *msg) |
| { |
| wmi_pdev_set_mac_config_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint32_t len; |
| |
| 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_pdev_set_mac_config_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_set_mac_config_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_set_mac_config_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| WMI_HOST_PDEV_ID_SOC); |
| cmd->concurrent_scan_config_bits = msg->scan_config; |
| cmd->fw_mode_config_bits = msg->fw_mode_config; |
| WMI_LOGD("%s: scan_config:%x fw_mode_config:%x", |
| __func__, msg->scan_config, msg->fw_mode_config); |
| |
| wmi_mtrace(WMI_PDEV_SET_MAC_CONFIG_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_SET_MAC_CONFIG_CMDID)) { |
| WMI_LOGE("%s: Failed to send WMI_PDEV_SET_MAC_CONFIG_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| } |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| #ifdef BIG_ENDIAN_HOST |
| /** |
| * fips_conv_data_be() - LE to BE conversion of FIPS ev data |
| * @param data_len - data length |
| * @param data - pointer to data |
| * |
| * Return: QDF_STATUS - success or error status |
| */ |
| static QDF_STATUS fips_align_data_be(wmi_unified_t wmi_handle, |
| struct fips_params *param) |
| { |
| unsigned char *key_unaligned, *data_unaligned; |
| int c; |
| u_int8_t *key_aligned = NULL; |
| u_int8_t *data_aligned = NULL; |
| |
| /* Assigning unaligned space to copy the key */ |
| key_unaligned = qdf_mem_malloc( |
| sizeof(u_int8_t)*param->key_len + FIPS_ALIGN); |
| data_unaligned = qdf_mem_malloc( |
| sizeof(u_int8_t)*param->data_len + FIPS_ALIGN); |
| |
| /* Checking if kmalloc is successful to allocate space */ |
| if (key_unaligned == NULL) |
| return QDF_STATUS_SUCCESS; |
| /* Checking if space is aligned */ |
| if (!FIPS_IS_ALIGNED(key_unaligned, FIPS_ALIGN)) { |
| /* align to 4 */ |
| key_aligned = |
| (u_int8_t *)FIPS_ALIGNTO(key_unaligned, |
| FIPS_ALIGN); |
| } else { |
| key_aligned = (u_int8_t *)key_unaligned; |
| } |
| |
| /* memset and copy content from key to key aligned */ |
| OS_MEMSET(key_aligned, 0, param->key_len); |
| OS_MEMCPY(key_aligned, param->key, param->key_len); |
| |
| /* print a hexdump for host debug */ |
| print_hex_dump(KERN_DEBUG, |
| "\t Aligned and Copied Key:@@@@ ", |
| DUMP_PREFIX_NONE, |
| 16, 1, key_aligned, param->key_len, true); |
| |
| /* Checking if kmalloc is successful to allocate space */ |
| if (data_unaligned == NULL) |
| return QDF_STATUS_SUCCESS; |
| /* Checking of space is aligned */ |
| if (!FIPS_IS_ALIGNED(data_unaligned, FIPS_ALIGN)) { |
| /* align to 4 */ |
| data_aligned = |
| (u_int8_t *)FIPS_ALIGNTO(data_unaligned, |
| FIPS_ALIGN); |
| } else { |
| data_aligned = (u_int8_t *)data_unaligned; |
| } |
| |
| /* memset and copy content from data to data aligned */ |
| OS_MEMSET(data_aligned, 0, param->data_len); |
| OS_MEMCPY(data_aligned, param->data, param->data_len); |
| |
| /* print a hexdump for host debug */ |
| print_hex_dump(KERN_DEBUG, |
| "\t Properly Aligned and Copied Data:@@@@ ", |
| DUMP_PREFIX_NONE, |
| 16, 1, data_aligned, param->data_len, true); |
| |
| /* converting to little Endian both key_aligned and |
| * data_aligned*/ |
| for (c = 0; c < param->key_len/4; c++) { |
| *((u_int32_t *)key_aligned+c) = |
| qdf_cpu_to_le32(*((u_int32_t *)key_aligned+c)); |
| } |
| for (c = 0; c < param->data_len/4; c++) { |
| *((u_int32_t *)data_aligned+c) = |
| qdf_cpu_to_le32(*((u_int32_t *)data_aligned+c)); |
| } |
| |
| /* update endian data to key and data vectors */ |
| OS_MEMCPY(param->key, key_aligned, param->key_len); |
| OS_MEMCPY(param->data, data_aligned, param->data_len); |
| |
| /* clean up allocated spaces */ |
| qdf_mem_free(key_unaligned); |
| key_unaligned = NULL; |
| key_aligned = NULL; |
| |
| qdf_mem_free(data_unaligned); |
| data_unaligned = NULL; |
| data_aligned = NULL; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #else |
| /** |
| * fips_align_data_be() - DUMMY for LE platform |
| * |
| * Return: QDF_STATUS - success |
| */ |
| static QDF_STATUS fips_align_data_be(wmi_unified_t wmi_handle, |
| struct fips_params *param) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| |
| /** |
| * send_pdev_fips_cmd_tlv() - send pdev fips cmd to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to hold pdev fips param |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| send_pdev_fips_cmd_tlv(wmi_unified_t wmi_handle, |
| struct fips_params *param) |
| { |
| wmi_pdev_fips_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| uint32_t len = sizeof(wmi_pdev_fips_cmd_fixed_param); |
| QDF_STATUS retval = QDF_STATUS_SUCCESS; |
| |
| /* Length TLV placeholder for array of bytes */ |
| len += WMI_TLV_HDR_SIZE; |
| if (param->data_len) |
| len += (param->data_len*sizeof(uint8_t)); |
| |
| /* |
| * Data length must be multiples of 16 bytes - checked against 0xF - |
| * and must be less than WMI_SVC_MSG_SIZE - static size of |
| * wmi_pdev_fips_cmd structure |
| */ |
| |
| /* do sanity on the input */ |
| if (!(((param->data_len & 0xF) == 0) && |
| ((param->data_len > 0) && |
| (param->data_len < (WMI_HOST_MAX_BUFFER_SIZE - |
| sizeof(wmi_pdev_fips_cmd_fixed_param)))))) { |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| qdf_print("%s:wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_pdev_fips_cmd_fixed_param *)buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_fips_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_fips_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| if (param->key != NULL && param->data != NULL) { |
| cmd->key_len = param->key_len; |
| cmd->data_len = param->data_len; |
| cmd->fips_cmd = !!(param->op); |
| |
| if (fips_align_data_be(wmi_handle, param) != QDF_STATUS_SUCCESS) |
| return QDF_STATUS_E_FAILURE; |
| |
| qdf_mem_copy(cmd->key, param->key, param->key_len); |
| |
| if (param->mode == FIPS_ENGINE_AES_CTR || |
| param->mode == FIPS_ENGINE_AES_MIC) { |
| cmd->mode = param->mode; |
| } else { |
| cmd->mode = FIPS_ENGINE_AES_CTR; |
| } |
| qdf_print("Key len = %d, Data len = %d", |
| cmd->key_len, cmd->data_len); |
| |
| print_hex_dump(KERN_DEBUG, "Key: ", DUMP_PREFIX_NONE, 16, 1, |
| cmd->key, cmd->key_len, true); |
| buf_ptr += sizeof(*cmd); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, param->data_len); |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| if (param->data_len) |
| qdf_mem_copy(buf_ptr, |
| (uint8_t *) param->data, param->data_len); |
| |
| print_hex_dump(KERN_DEBUG, "Plain text: ", DUMP_PREFIX_NONE, |
| 16, 1, buf_ptr, cmd->data_len, true); |
| |
| buf_ptr += param->data_len; |
| |
| wmi_mtrace(WMI_PDEV_FIPS_CMDID, NO_SESSION, 0); |
| retval = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_FIPS_CMDID); |
| qdf_print("%s return value %d", __func__, retval); |
| } else { |
| qdf_print("\n%s:%d Key or Data is NULL", __func__, __LINE__); |
| wmi_buf_free(buf); |
| retval = -QDF_STATUS_E_BADMSG; |
| } |
| |
| return retval; |
| } |
| |
| #ifdef WLAN_POWER_MANAGEMENT_OFFLOAD |
| /** |
| * send_add_wow_wakeup_event_cmd_tlv() - Configures wow wakeup events. |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @bitmap: Event bitmap |
| * @enable: enable/disable |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_add_wow_wakeup_event_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t vdev_id, |
| uint32_t *bitmap, |
| bool enable) |
| { |
| WMI_WOW_ADD_DEL_EVT_CMD_fixed_param *cmd; |
| uint16_t len; |
| wmi_buf_t buf; |
| int ret; |
| |
| len = sizeof(WMI_WOW_ADD_DEL_EVT_CMD_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (WMI_WOW_ADD_DEL_EVT_CMD_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_WOW_ADD_DEL_EVT_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_WOW_ADD_DEL_EVT_CMD_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->is_add = enable; |
| qdf_mem_copy(&(cmd->event_bitmaps[0]), bitmap, sizeof(uint32_t) * |
| WMI_WOW_MAX_EVENT_BM_LEN); |
| |
| WMI_LOGD("Wakeup pattern 0x%x%x%x%x %s in fw", cmd->event_bitmaps[0], |
| cmd->event_bitmaps[1], cmd->event_bitmaps[2], |
| cmd->event_bitmaps[3], enable ? "enabled" : "disabled"); |
| |
| wmi_mtrace(WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID); |
| if (ret) { |
| WMI_LOGE("Failed to config wow wakeup event"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_wow_patterns_to_fw_cmd_tlv() - Sends WOW patterns to FW. |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @ptrn_id: pattern id |
| * @ptrn: pattern |
| * @ptrn_len: pattern length |
| * @ptrn_offset: pattern offset |
| * @mask: mask |
| * @mask_len: mask length |
| * @user: true for user configured pattern and false for default pattern |
| * @default_patterns: default patterns |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_wow_patterns_to_fw_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, uint8_t ptrn_id, |
| const uint8_t *ptrn, uint8_t ptrn_len, |
| uint8_t ptrn_offset, const uint8_t *mask, |
| uint8_t mask_len, bool user, |
| uint8_t default_patterns) |
| { |
| WMI_WOW_ADD_PATTERN_CMD_fixed_param *cmd; |
| WOW_BITMAP_PATTERN_T *bitmap_pattern; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| 1 * sizeof(WOW_BITMAP_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_IPV4_SYNC_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_IPV6_SYNC_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_MAGIC_PATTERN_CMD) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(uint32_t) + WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_WOW_ADD_PATTERN_CMD_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_WOW_ADD_PATTERN_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_WOW_ADD_PATTERN_CMD_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->pattern_id = ptrn_id; |
| |
| cmd->pattern_type = WOW_BITMAP_PATTERN; |
| buf_ptr += sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(WOW_BITMAP_PATTERN_T)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| bitmap_pattern = (WOW_BITMAP_PATTERN_T *) buf_ptr; |
| |
| WMITLV_SET_HDR(&bitmap_pattern->tlv_header, |
| WMITLV_TAG_STRUC_WOW_BITMAP_PATTERN_T, |
| WMITLV_GET_STRUCT_TLVLEN(WOW_BITMAP_PATTERN_T)); |
| |
| qdf_mem_copy(&bitmap_pattern->patternbuf[0], ptrn, ptrn_len); |
| qdf_mem_copy(&bitmap_pattern->bitmaskbuf[0], mask, mask_len); |
| |
| bitmap_pattern->pattern_offset = ptrn_offset; |
| bitmap_pattern->pattern_len = ptrn_len; |
| |
| if (bitmap_pattern->pattern_len > WOW_DEFAULT_BITMAP_PATTERN_SIZE) |
| bitmap_pattern->pattern_len = WOW_DEFAULT_BITMAP_PATTERN_SIZE; |
| |
| if (bitmap_pattern->pattern_len > WOW_DEFAULT_BITMASK_SIZE) |
| bitmap_pattern->pattern_len = WOW_DEFAULT_BITMASK_SIZE; |
| |
| bitmap_pattern->bitmask_len = bitmap_pattern->pattern_len; |
| bitmap_pattern->pattern_id = ptrn_id; |
| |
| WMI_LOGD("vdev: %d, ptrn id: %d, ptrn len: %d, ptrn offset: %d user %d", |
| cmd->vdev_id, cmd->pattern_id, bitmap_pattern->pattern_len, |
| bitmap_pattern->pattern_offset, user); |
| WMI_LOGD("Pattern : "); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| &bitmap_pattern->patternbuf[0], |
| bitmap_pattern->pattern_len); |
| |
| WMI_LOGD("Mask : "); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| &bitmap_pattern->bitmaskbuf[0], |
| bitmap_pattern->pattern_len); |
| |
| buf_ptr += sizeof(WOW_BITMAP_PATTERN_T); |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV4_SYNC_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV6_SYNC_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_MAGIC_PATTERN_CMD but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for pattern_info_timeout but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for ratelimit_interval with dummy data as this fix elem */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 1 * sizeof(uint32_t)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| *(uint32_t *) buf_ptr = 0; |
| |
| wmi_mtrace(WMI_WOW_ADD_WAKE_PATTERN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_ADD_WAKE_PATTERN_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send wow ptrn to fw", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * fill_arp_offload_params_tlv() - Fill ARP offload data |
| * @wmi_handle: wmi handle |
| * @offload_req: offload request |
| * @buf_ptr: buffer pointer |
| * |
| * To fill ARP offload data to firmware |
| * when target goes to wow mode. |
| * |
| * Return: None |
| */ |
| static void fill_arp_offload_params_tlv(wmi_unified_t wmi_handle, |
| struct pmo_arp_offload_params *offload_req, uint8_t **buf_ptr) |
| { |
| |
| int i; |
| WMI_ARP_OFFLOAD_TUPLE *arp_tuple; |
| bool enable_or_disable = offload_req->enable; |
| |
| WMITLV_SET_HDR(*buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (WMI_MAX_ARP_OFFLOADS*sizeof(WMI_ARP_OFFLOAD_TUPLE))); |
| *buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = 0; i < WMI_MAX_ARP_OFFLOADS; i++) { |
| arp_tuple = (WMI_ARP_OFFLOAD_TUPLE *)*buf_ptr; |
| WMITLV_SET_HDR(&arp_tuple->tlv_header, |
| WMITLV_TAG_STRUC_WMI_ARP_OFFLOAD_TUPLE, |
| WMITLV_GET_STRUCT_TLVLEN(WMI_ARP_OFFLOAD_TUPLE)); |
| |
| /* Fill data for ARP and NS in the first tupple for LA */ |
| if ((enable_or_disable & PMO_OFFLOAD_ENABLE) && (i == 0)) { |
| /* Copy the target ip addr and flags */ |
| arp_tuple->flags = WMI_ARPOFF_FLAGS_VALID; |
| qdf_mem_copy(&arp_tuple->target_ipaddr, |
| offload_req->host_ipv4_addr, |
| WMI_IPV4_ADDR_LEN); |
| WMI_LOGD("ARPOffload IP4 address: %pI4", |
| offload_req->host_ipv4_addr); |
| } |
| *buf_ptr += sizeof(WMI_ARP_OFFLOAD_TUPLE); |
| } |
| } |
| |
| #ifdef WLAN_NS_OFFLOAD |
| /** |
| * fill_ns_offload_params_tlv() - Fill NS offload data |
| * @wmi|_handle: wmi handle |
| * @offload_req: offload request |
| * @buf_ptr: buffer pointer |
| * |
| * To fill NS offload data to firmware |
| * when target goes to wow mode. |
| * |
| * Return: None |
| */ |
| static void fill_ns_offload_params_tlv(wmi_unified_t wmi_handle, |
| struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr) |
| { |
| |
| int i; |
| WMI_NS_OFFLOAD_TUPLE *ns_tuple; |
| |
| WMITLV_SET_HDR(*buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (WMI_MAX_NS_OFFLOADS * sizeof(WMI_NS_OFFLOAD_TUPLE))); |
| *buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = 0; i < WMI_MAX_NS_OFFLOADS; i++) { |
| ns_tuple = (WMI_NS_OFFLOAD_TUPLE *)*buf_ptr; |
| WMITLV_SET_HDR(&ns_tuple->tlv_header, |
| WMITLV_TAG_STRUC_WMI_NS_OFFLOAD_TUPLE, |
| (sizeof(WMI_NS_OFFLOAD_TUPLE) - WMI_TLV_HDR_SIZE)); |
| |
| /* |
| * Fill data only for NS offload in the first ARP tuple for LA |
| */ |
| if ((ns_req->enable & PMO_OFFLOAD_ENABLE)) { |
| ns_tuple->flags |= WMI_NSOFF_FLAGS_VALID; |
| /* Copy the target/solicitation/remote ip addr */ |
| if (ns_req->target_ipv6_addr_valid[i]) |
| qdf_mem_copy(&ns_tuple->target_ipaddr[0], |
| &ns_req->target_ipv6_addr[i], |
| sizeof(WMI_IPV6_ADDR)); |
| qdf_mem_copy(&ns_tuple->solicitation_ipaddr, |
| &ns_req->self_ipv6_addr[i], |
| sizeof(WMI_IPV6_ADDR)); |
| if (ns_req->target_ipv6_addr_ac_type[i]) { |
| ns_tuple->flags |= |
| WMI_NSOFF_FLAGS_IS_IPV6_ANYCAST; |
| } |
| WMI_LOGD("Index %d NS solicitedIp %pI6, targetIp %pI6", |
| i, &ns_req->self_ipv6_addr[i], |
| &ns_req->target_ipv6_addr[i]); |
| |
| /* target MAC is optional, check if it is valid, |
| * if this is not valid, the target will use the known |
| * local MAC address rather than the tuple |
| */ |
| WMI_CHAR_ARRAY_TO_MAC_ADDR( |
| ns_req->self_macaddr.bytes, |
| &ns_tuple->target_mac); |
| if ((ns_tuple->target_mac.mac_addr31to0 != 0) || |
| (ns_tuple->target_mac.mac_addr47to32 != 0)) { |
| ns_tuple->flags |= WMI_NSOFF_FLAGS_MAC_VALID; |
| } |
| } |
| *buf_ptr += sizeof(WMI_NS_OFFLOAD_TUPLE); |
| } |
| } |
| |
| |
| /** |
| * fill_nsoffload_ext_tlv() - Fill NS offload ext data |
| * @wmi: wmi handle |
| * @offload_req: offload request |
| * @buf_ptr: buffer pointer |
| * |
| * To fill extended NS offload extended data to firmware |
| * when target goes to wow mode. |
| * |
| * Return: None |
| */ |
| static void fill_nsoffload_ext_tlv(wmi_unified_t wmi_handle, |
| struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr) |
| { |
| int i; |
| WMI_NS_OFFLOAD_TUPLE *ns_tuple; |
| uint32_t count, num_ns_ext_tuples; |
| |
| count = ns_req->num_ns_offload_count; |
| num_ns_ext_tuples = ns_req->num_ns_offload_count - |
| WMI_MAX_NS_OFFLOADS; |
| |
| /* Populate extended NS offload tuples */ |
| WMITLV_SET_HDR(*buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| (num_ns_ext_tuples * sizeof(WMI_NS_OFFLOAD_TUPLE))); |
| *buf_ptr += WMI_TLV_HDR_SIZE; |
| for (i = WMI_MAX_NS_OFFLOADS; i < count; i++) { |
| ns_tuple = (WMI_NS_OFFLOAD_TUPLE *)*buf_ptr; |
| WMITLV_SET_HDR(&ns_tuple->tlv_header, |
| WMITLV_TAG_STRUC_WMI_NS_OFFLOAD_TUPLE, |
| (sizeof(WMI_NS_OFFLOAD_TUPLE)-WMI_TLV_HDR_SIZE)); |
| |
| /* |
| * Fill data only for NS offload in the first ARP tuple for LA |
| */ |
| if ((ns_req->enable & PMO_OFFLOAD_ENABLE)) { |
| ns_tuple->flags |= WMI_NSOFF_FLAGS_VALID; |
| /* Copy the target/solicitation/remote ip addr */ |
| if (ns_req->target_ipv6_addr_valid[i]) |
| qdf_mem_copy(&ns_tuple->target_ipaddr[0], |
| &ns_req->target_ipv6_addr[i], |
| sizeof(WMI_IPV6_ADDR)); |
| qdf_mem_copy(&ns_tuple->solicitation_ipaddr, |
| &ns_req->self_ipv6_addr[i], |
| sizeof(WMI_IPV6_ADDR)); |
| if (ns_req->target_ipv6_addr_ac_type[i]) { |
| ns_tuple->flags |= |
| WMI_NSOFF_FLAGS_IS_IPV6_ANYCAST; |
| } |
| WMI_LOGD("Index %d NS solicitedIp %pI6, targetIp %pI6", |
| i, &ns_req->self_ipv6_addr[i], |
| &ns_req->target_ipv6_addr[i]); |
| |
| /* target MAC is optional, check if it is valid, |
| * if this is not valid, the target will use the |
| * known local MAC address rather than the tuple |
| */ |
| WMI_CHAR_ARRAY_TO_MAC_ADDR( |
| ns_req->self_macaddr.bytes, |
| &ns_tuple->target_mac); |
| if ((ns_tuple->target_mac.mac_addr31to0 != 0) || |
| (ns_tuple->target_mac.mac_addr47to32 != 0)) { |
| ns_tuple->flags |= WMI_NSOFF_FLAGS_MAC_VALID; |
| } |
| } |
| *buf_ptr += sizeof(WMI_NS_OFFLOAD_TUPLE); |
| } |
| } |
| #else |
| static void fill_ns_offload_params_tlv(wmi_unified_t wmi_handle, |
| struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr) |
| { |
| } |
| |
| static void fill_nsoffload_ext_tlv(wmi_unified_t wmi_handle, |
| struct pmo_ns_offload_params *ns_req, uint8_t **buf_ptr) |
| { |
| } |
| #endif |
| |
| /** |
| * send_enable_arp_ns_offload_cmd_tlv() - enable ARP NS offload |
| * @wma: wmi handle |
| * @arp_offload_req: arp offload request |
| * @ns_offload_req: ns offload request |
| * @arp_only: flag |
| * |
| * To configure ARP NS off load data to firmware |
| * when target goes to wow mode. |
| * |
| * Return: QDF Status |
| */ |
| static QDF_STATUS send_enable_arp_ns_offload_cmd_tlv(wmi_unified_t wmi_handle, |
| struct pmo_arp_offload_params *arp_offload_req, |
| struct pmo_ns_offload_params *ns_offload_req, |
| uint8_t vdev_id) |
| { |
| int32_t res; |
| WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| wmi_buf_t buf; |
| int32_t len; |
| uint32_t count = 0, num_ns_ext_tuples = 0; |
| |
| count = ns_offload_req->num_ns_offload_count; |
| |
| /* |
| * TLV place holder size for array of NS tuples |
| * TLV place holder size for array of ARP tuples |
| */ |
| len = sizeof(WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| WMI_MAX_NS_OFFLOADS * sizeof(WMI_NS_OFFLOAD_TUPLE) + |
| WMI_TLV_HDR_SIZE + |
| WMI_MAX_ARP_OFFLOADS * sizeof(WMI_ARP_OFFLOAD_TUPLE); |
| |
| /* |
| * If there are more than WMI_MAX_NS_OFFLOADS addresses then allocate |
| * extra length for extended NS offload tuples which follows ARP offload |
| * tuples. Host needs to fill this structure in following format: |
| * 2 NS ofload tuples |
| * 2 ARP offload tuples |
| * N numbers of extended NS offload tuples if HDD has given more than |
| * 2 NS offload addresses |
| */ |
| if (count > WMI_MAX_NS_OFFLOADS) { |
| num_ns_ext_tuples = count - WMI_MAX_NS_OFFLOADS; |
| len += WMI_TLV_HDR_SIZE + num_ns_ext_tuples |
| * sizeof(WMI_NS_OFFLOAD_TUPLE); |
| } |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param)); |
| cmd->flags = 0; |
| cmd->vdev_id = vdev_id; |
| cmd->num_ns_ext_tuples = num_ns_ext_tuples; |
| |
| WMI_LOGD("ARP NS Offload vdev_id: %d", cmd->vdev_id); |
| |
| buf_ptr += sizeof(WMI_SET_ARP_NS_OFFLOAD_CMD_fixed_param); |
| fill_ns_offload_params_tlv(wmi_handle, ns_offload_req, &buf_ptr); |
| fill_arp_offload_params_tlv(wmi_handle, arp_offload_req, &buf_ptr); |
| if (num_ns_ext_tuples) |
| fill_nsoffload_ext_tlv(wmi_handle, ns_offload_req, &buf_ptr); |
| |
| wmi_mtrace(WMI_SET_ARP_NS_OFFLOAD_CMDID, cmd->vdev_id, 0); |
| res = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_SET_ARP_NS_OFFLOAD_CMDID); |
| if (res) { |
| WMI_LOGE("Failed to enable ARP NDP/NSffload"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_enable_enhance_multicast_offload_tlv() - send enhance multicast offload |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @action: true for enable else false |
| * |
| * To enable enhance multicast offload to firmware |
| * when target goes to wow mode. |
| * |
| * Return: QDF Status |
| */ |
| |
| static |
| QDF_STATUS send_enable_enhance_multicast_offload_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t vdev_id, bool action) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf; |
| wmi_config_enhanced_mcast_filter_cmd_fixed_param *cmd; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set key cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_config_enhanced_mcast_filter_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_config_enhanced_mcast_filter_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_config_enhanced_mcast_filter_cmd_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| cmd->enable = ((action == 0) ? ENHANCED_MCAST_FILTER_DISABLED : |
| ENHANCED_MCAST_FILTER_ENABLED); |
| WMI_LOGD("%s: config enhance multicast offload action %d for vdev %d", |
| __func__, action, vdev_id); |
| wmi_mtrace(WMI_CONFIG_ENHANCED_MCAST_FILTER_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), WMI_CONFIG_ENHANCED_MCAST_FILTER_CMDID); |
| if (status != QDF_STATUS_SUCCESS) { |
| wmi_buf_free(buf); |
| WMI_LOGE("%s:Failed to send ENHANCED_MCAST_FILTER_CMDID", |
| __func__); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * extract_gtk_rsp_event_tlv() - extract gtk rsp params from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param hdr: Pointer to hold header |
| * @param bufp: Pointer to hold pointer to rx param buffer |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_gtk_rsp_event_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct pmo_gtk_rsp_params *gtk_rsp_param, uint32_t len) |
| { |
| WMI_GTK_OFFLOAD_STATUS_EVENT_fixed_param *fixed_param; |
| WMI_GTK_OFFLOAD_STATUS_EVENTID_param_tlvs *param_buf; |
| |
| param_buf = (WMI_GTK_OFFLOAD_STATUS_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("gtk param_buf is NULL"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (len < sizeof(WMI_GTK_OFFLOAD_STATUS_EVENT_fixed_param)) { |
| WMI_LOGE("Invalid length for GTK status"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| fixed_param = (WMI_GTK_OFFLOAD_STATUS_EVENT_fixed_param *) |
| param_buf->fixed_param; |
| gtk_rsp_param->vdev_id = fixed_param->vdev_id; |
| gtk_rsp_param->status_flag = QDF_STATUS_SUCCESS; |
| gtk_rsp_param->refresh_cnt = fixed_param->refresh_cnt; |
| qdf_mem_copy(>k_rsp_param->replay_counter, |
| &fixed_param->replay_counter, |
| GTK_REPLAY_COUNTER_BYTES); |
| |
| return QDF_STATUS_SUCCESS; |
| |
| } |
| |
| #ifdef FEATURE_WLAN_RA_FILTERING |
| /** |
| * send_wow_sta_ra_filter_cmd_tlv() - set RA filter pattern in fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_wow_sta_ra_filter_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, uint8_t default_pattern, |
| uint16_t rate_limit_interval) |
| { |
| |
| WMI_WOW_ADD_PATTERN_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint8_t *buf_ptr; |
| int32_t len; |
| int ret; |
| |
| len = sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_BITMAP_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_IPV4_SYNC_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_IPV6_SYNC_PATTERN_T) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(WOW_MAGIC_PATTERN_CMD) + |
| WMI_TLV_HDR_SIZE + |
| 0 * sizeof(uint32_t) + WMI_TLV_HDR_SIZE + 1 * sizeof(uint32_t); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_WOW_ADD_PATTERN_CMD_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *) cmd; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_WOW_ADD_PATTERN_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_WOW_ADD_PATTERN_CMD_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->pattern_id = default_pattern, |
| cmd->pattern_type = WOW_IPV6_RA_PATTERN; |
| buf_ptr += sizeof(WMI_WOW_ADD_PATTERN_CMD_fixed_param); |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_BITMAP_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV4_SYNC_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_IPV6_SYNC_PATTERN_T but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for WMITLV_TAG_STRUC_WOW_MAGIC_PATTERN_CMD but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for pattern_info_timeout but no data. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, 0); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| /* Fill TLV for ra_ratelimit_interval. */ |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, sizeof(uint32_t)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| *((uint32_t *) buf_ptr) = rate_limit_interval; |
| |
| WMI_LOGD("%s: send RA rate limit [%d] to fw vdev = %d", __func__, |
| rate_limit_interval, vdev_id); |
| |
| wmi_mtrace(WMI_WOW_ADD_WAKE_PATTERN_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_WOW_ADD_WAKE_PATTERN_CMDID); |
| if (ret) { |
| WMI_LOGE("%s: Failed to send RA rate limit to fw", __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| |
| } |
| #endif /* FEATURE_WLAN_RA_FILTERING */ |
| |
| /** |
| * send_add_clear_mcbc_filter_cmd_tlv() - set mcast filter command to fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @multicastAddr: mcast address |
| * @clearList: clear list flag |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_add_clear_mcbc_filter_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, |
| struct qdf_mac_addr multicast_addr, |
| bool clearList) |
| { |
| WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| int err; |
| |
| buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd)); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set_param cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param *) wmi_buf_data(buf); |
| qdf_mem_zero(cmd, sizeof(*cmd)); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_SET_MCASTBCAST_FILTER_CMD_fixed_param)); |
| cmd->action = |
| (clearList ? WMI_MCAST_FILTER_DELETE : WMI_MCAST_FILTER_SET); |
| cmd->vdev_id = vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(multicast_addr.bytes, &cmd->mcastbdcastaddr); |
| |
| WMI_LOGD("Action:%d; vdev_id:%d; clearList:%d; MCBC MAC Addr: %pM", |
| cmd->action, vdev_id, clearList, multicast_addr.bytes); |
| |
| wmi_mtrace(WMI_SET_MCASTBCAST_FILTER_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| sizeof(*cmd), |
| WMI_SET_MCASTBCAST_FILTER_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send set_param cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_multiple_add_clear_mcbc_filter_cmd_tlv() - send multiple mcast filter |
| * command to fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @mcast_filter_params: mcast filter params |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_multiple_add_clear_mcbc_filter_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t vdev_id, |
| struct pmo_mcast_filter_params *filter_param) |
| |
| { |
| WMI_SET_MULTIPLE_MCAST_FILTER_CMD_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| wmi_buf_t buf; |
| int err; |
| int i; |
| uint8_t *mac_addr_src_ptr = NULL; |
| wmi_mac_addr *mac_addr_dst_ptr; |
| uint32_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + |
| sizeof(wmi_mac_addr) * filter_param->multicast_addr_cnt; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate memory"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (WMI_SET_MULTIPLE_MCAST_FILTER_CMD_fixed_param *) |
| wmi_buf_data(buf); |
| qdf_mem_zero(cmd, sizeof(*cmd)); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_set_multiple_mcast_filter_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_SET_MULTIPLE_MCAST_FILTER_CMD_fixed_param)); |
| cmd->operation = |
| ((filter_param->action == 0) ? WMI_MULTIPLE_MCAST_FILTER_DELETE |
| : WMI_MULTIPLE_MCAST_FILTER_ADD); |
| cmd->vdev_id = vdev_id; |
| cmd->num_mcastaddrs = filter_param->multicast_addr_cnt; |
| |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC, |
| sizeof(wmi_mac_addr) * |
| filter_param->multicast_addr_cnt); |
| |
| if (filter_param->multicast_addr_cnt == 0) |
| goto send_cmd; |
| |
| mac_addr_src_ptr = (uint8_t *)&filter_param->multicast_addr; |
| mac_addr_dst_ptr = (wmi_mac_addr *) |
| (buf_ptr + WMI_TLV_HDR_SIZE); |
| |
| for (i = 0; i < filter_param->multicast_addr_cnt; i++) { |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(mac_addr_src_ptr, mac_addr_dst_ptr); |
| mac_addr_src_ptr += ATH_MAC_LEN; |
| mac_addr_dst_ptr++; |
| } |
| |
| send_cmd: |
| wmi_mtrace(WMI_SET_MULTIPLE_MCAST_FILTER_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| len, |
| WMI_SET_MULTIPLE_MCAST_FILTER_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send set_param cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static void |
| fill_fils_tlv_params(WMI_GTK_OFFLOAD_CMD_fixed_param *cmd, |
| uint8_t vdev_id, |
| struct pmo_gtk_req *params) |
| { |
| uint8_t *buf_ptr; |
| wmi_gtk_offload_fils_tlv_param *ext_param; |
| |
| buf_ptr = (uint8_t *) cmd + sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(*ext_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| ext_param = (wmi_gtk_offload_fils_tlv_param *)buf_ptr; |
| WMITLV_SET_HDR(&ext_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_gtk_offload_extended_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_gtk_offload_fils_tlv_param)); |
| ext_param->vdev_id = vdev_id; |
| ext_param->flags = cmd->flags; |
| ext_param->kek_len = params->kek_len; |
| qdf_mem_copy(ext_param->KEK, params->kek, params->kek_len); |
| qdf_mem_copy(ext_param->KCK, params->kck, |
| WMI_GTK_OFFLOAD_KCK_BYTES); |
| qdf_mem_copy(ext_param->replay_counter, ¶ms->replay_counter, |
| GTK_REPLAY_COUNTER_BYTES); |
| } |
| |
| /** |
| * send_gtk_offload_cmd_tlv() - send GTK offload command to fw |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @params: GTK offload parameters |
| * |
| * Return: CDF status |
| */ |
| static |
| QDF_STATUS send_gtk_offload_cmd_tlv(wmi_unified_t wmi_handle, uint8_t vdev_id, |
| struct pmo_gtk_req *params, |
| bool enable_offload, |
| uint32_t gtk_offload_opcode) |
| { |
| int len; |
| wmi_buf_t buf; |
| WMI_GTK_OFFLOAD_CMD_fixed_param *cmd; |
| QDF_STATUS status = QDF_STATUS_SUCCESS; |
| |
| WMI_LOGD("%s Enter", __func__); |
| |
| len = sizeof(*cmd); |
| |
| if (params->is_fils_connection) |
| len += WMI_TLV_HDR_SIZE + |
| sizeof(wmi_gtk_offload_fils_tlv_param); |
| |
| /* alloc wmi buffer */ |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("wmi_buf_alloc failed for WMI_GTK_OFFLOAD_CMD"); |
| status = QDF_STATUS_E_NOMEM; |
| goto out; |
| } |
| |
| cmd = (WMI_GTK_OFFLOAD_CMD_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_GTK_OFFLOAD_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_GTK_OFFLOAD_CMD_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| |
| /* Request target to enable GTK offload */ |
| if (enable_offload == PMO_GTK_OFFLOAD_ENABLE) { |
| cmd->flags = gtk_offload_opcode; |
| |
| /* Copy the keys and replay counter */ |
| qdf_mem_copy(cmd->KCK, params->kck, PMO_KCK_LEN); |
| qdf_mem_copy(cmd->KEK, params->kek, PMO_KEK_LEN_LEGACY); |
| qdf_mem_copy(cmd->replay_counter, ¶ms->replay_counter, |
| GTK_REPLAY_COUNTER_BYTES); |
| } else { |
| cmd->flags = gtk_offload_opcode; |
| } |
| if (params->is_fils_connection) |
| fill_fils_tlv_params(cmd, vdev_id, params); |
| |
| WMI_LOGD("VDEVID: %d, GTK_FLAGS: x%x kek len %d", vdev_id, cmd->flags, params->kek_len); |
| /* send the wmi command */ |
| wmi_mtrace(WMI_GTK_OFFLOAD_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_GTK_OFFLOAD_CMDID)) { |
| WMI_LOGE("Failed to send WMI_GTK_OFFLOAD_CMDID"); |
| wmi_buf_free(buf); |
| status = QDF_STATUS_E_FAILURE; |
| } |
| |
| out: |
| WMI_LOGD("%s Exit", __func__); |
| return status; |
| } |
| |
| /** |
| * send_process_gtk_offload_getinfo_cmd_tlv() - send GTK offload cmd to fw |
| * @wmi_handle: wmi handle |
| * @params: GTK offload params |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_process_gtk_offload_getinfo_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t vdev_id, |
| uint64_t offload_req_opcode) |
| { |
| int len; |
| wmi_buf_t buf; |
| WMI_GTK_OFFLOAD_CMD_fixed_param *cmd; |
| QDF_STATUS status = QDF_STATUS_SUCCESS; |
| |
| len = sizeof(*cmd); |
| |
| /* alloc wmi buffer */ |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("wmi_buf_alloc failed for WMI_GTK_OFFLOAD_CMD"); |
| status = QDF_STATUS_E_NOMEM; |
| goto out; |
| } |
| |
| cmd = (WMI_GTK_OFFLOAD_CMD_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_WMI_GTK_OFFLOAD_CMD_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_GTK_OFFLOAD_CMD_fixed_param)); |
| |
| /* Request for GTK offload status */ |
| cmd->flags = offload_req_opcode; |
| cmd->vdev_id = vdev_id; |
| |
| /* send the wmi command */ |
| wmi_mtrace(WMI_GTK_OFFLOAD_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_GTK_OFFLOAD_CMDID)) { |
| WMI_LOGE("Failed to send WMI_GTK_OFFLOAD_CMDID for req info"); |
| wmi_buf_free(buf); |
| status = QDF_STATUS_E_FAILURE; |
| } |
| |
| out: |
| return status; |
| } |
| |
| /** |
| * send_action_frame_patterns_cmd_tlv() - send wmi cmd of action filter params |
| * @wmi_handle: wmi handler |
| * @action_params: pointer to action_params |
| * |
| * Return: 0 for success, otherwise appropriate error code |
| */ |
| static QDF_STATUS send_action_frame_patterns_cmd_tlv(wmi_unified_t wmi_handle, |
| struct pmo_action_wakeup_set_params *action_params) |
| { |
| WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param *cmd; |
| wmi_buf_t buf; |
| int i; |
| int32_t err; |
| uint32_t len = 0, *cmd_args; |
| uint8_t *buf_ptr; |
| |
| len = (PMO_SUPPORTED_ACTION_CATE * sizeof(uint32_t)) |
| + WMI_TLV_HDR_SIZE + sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send action filter cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param *) wmi_buf_data(buf); |
| buf_ptr = (uint8_t *)cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_wow_set_action_wake_up_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param)); |
| |
| cmd->vdev_id = action_params->vdev_id; |
| cmd->operation = action_params->operation; |
| |
| for (i = 0; i < MAX_SUPPORTED_ACTION_CATEGORY_ELE_LIST; i++) |
| cmd->action_category_map[i] = |
| action_params->action_category_map[i]; |
| |
| buf_ptr += sizeof(WMI_WOW_SET_ACTION_WAKE_UP_CMD_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (PMO_SUPPORTED_ACTION_CATE * sizeof(uint32_t))); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| cmd_args = (uint32_t *) buf_ptr; |
| for (i = 0; i < PMO_SUPPORTED_ACTION_CATE; i++) |
| cmd_args[i] = action_params->action_per_category[i]; |
| |
| wmi_mtrace(WMI_WOW_SET_ACTION_WAKE_UP_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_WOW_SET_ACTION_WAKE_UP_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send ap_ps_egap cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef FEATURE_WLAN_LPHB |
| |
| /** |
| * send_lphb_config_hbenable_cmd_tlv() - enable command of LPHB configuration |
| * @wmi_handle: wmi handle |
| * @lphb_conf_req: configuration info |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_lphb_config_hbenable_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_hb_set_enable_cmd_fixed_param *params) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_hb_set_enable_cmd_fixed_param *hb_enable_fp; |
| int len = sizeof(wmi_hb_set_enable_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| hb_enable_fp = (wmi_hb_set_enable_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&hb_enable_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_hb_set_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_hb_set_enable_cmd_fixed_param)); |
| |
| /* fill in values */ |
| hb_enable_fp->vdev_id = params->session; |
| hb_enable_fp->enable = params->enable; |
| hb_enable_fp->item = params->item; |
| hb_enable_fp->session = params->session; |
| |
| wmi_mtrace(WMI_HB_SET_ENABLE_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_HB_SET_ENABLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd_send WMI_HB_SET_ENABLE returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_lphb_config_tcp_params_cmd_tlv() - set tcp params of LPHB configuration |
| * @wmi_handle: wmi handle |
| * @lphb_conf_req: lphb config request |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_lphb_config_tcp_params_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_hb_set_tcp_params_cmd_fixed_param *lphb_conf_req) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_hb_set_tcp_params_cmd_fixed_param *hb_tcp_params_fp; |
| int len = sizeof(wmi_hb_set_tcp_params_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| hb_tcp_params_fp = (wmi_hb_set_tcp_params_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&hb_tcp_params_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_hb_set_tcp_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_hb_set_tcp_params_cmd_fixed_param)); |
| |
| /* fill in values */ |
| hb_tcp_params_fp->vdev_id = lphb_conf_req->vdev_id; |
| hb_tcp_params_fp->srv_ip = lphb_conf_req->srv_ip; |
| hb_tcp_params_fp->dev_ip = lphb_conf_req->dev_ip; |
| hb_tcp_params_fp->seq = lphb_conf_req->seq; |
| hb_tcp_params_fp->src_port = lphb_conf_req->src_port; |
| hb_tcp_params_fp->dst_port = lphb_conf_req->dst_port; |
| hb_tcp_params_fp->interval = lphb_conf_req->interval; |
| hb_tcp_params_fp->timeout = lphb_conf_req->timeout; |
| hb_tcp_params_fp->session = lphb_conf_req->session; |
| qdf_mem_copy(&hb_tcp_params_fp->gateway_mac, |
| &lphb_conf_req->gateway_mac, |
| sizeof(hb_tcp_params_fp->gateway_mac)); |
| |
| wmi_mtrace(WMI_HB_SET_TCP_PARAMS_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_HB_SET_TCP_PARAMS_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd_send WMI_HB_SET_TCP_PARAMS returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_lphb_config_tcp_pkt_filter_cmd_tlv() - configure tcp packet filter cmd |
| * @wmi_handle: wmi handle |
| * @lphb_conf_req: lphb config request |
| * |
| * Return: CDF status |
| */ |
| static |
| QDF_STATUS send_lphb_config_tcp_pkt_filter_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_hb_set_tcp_pkt_filter_cmd_fixed_param *g_hb_tcp_filter_fp) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_hb_set_tcp_pkt_filter_cmd_fixed_param *hb_tcp_filter_fp; |
| int len = sizeof(wmi_hb_set_tcp_pkt_filter_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| hb_tcp_filter_fp = |
| (wmi_hb_set_tcp_pkt_filter_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&hb_tcp_filter_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_hb_set_tcp_pkt_filter_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_hb_set_tcp_pkt_filter_cmd_fixed_param)); |
| |
| /* fill in values */ |
| hb_tcp_filter_fp->vdev_id = g_hb_tcp_filter_fp->vdev_id; |
| hb_tcp_filter_fp->length = g_hb_tcp_filter_fp->length; |
| hb_tcp_filter_fp->offset = g_hb_tcp_filter_fp->offset; |
| hb_tcp_filter_fp->session = g_hb_tcp_filter_fp->session; |
| memcpy((void *)&hb_tcp_filter_fp->filter, |
| (void *)&g_hb_tcp_filter_fp->filter, |
| WMI_WLAN_HB_MAX_FILTER_SIZE); |
| |
| wmi_mtrace(WMI_HB_SET_TCP_PKT_FILTER_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_HB_SET_TCP_PKT_FILTER_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd_send WMI_HB_SET_TCP_PKT_FILTER returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_lphb_config_udp_params_cmd_tlv() - configure udp param command of LPHB |
| * @wmi_handle: wmi handle |
| * @lphb_conf_req: lphb config request |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_lphb_config_udp_params_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_hb_set_udp_params_cmd_fixed_param *lphb_conf_req) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_hb_set_udp_params_cmd_fixed_param *hb_udp_params_fp; |
| int len = sizeof(wmi_hb_set_udp_params_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| hb_udp_params_fp = (wmi_hb_set_udp_params_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&hb_udp_params_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_hb_set_udp_params_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_hb_set_udp_params_cmd_fixed_param)); |
| |
| /* fill in values */ |
| hb_udp_params_fp->vdev_id = lphb_conf_req->vdev_id; |
| hb_udp_params_fp->srv_ip = lphb_conf_req->srv_ip; |
| hb_udp_params_fp->dev_ip = lphb_conf_req->dev_ip; |
| hb_udp_params_fp->src_port = lphb_conf_req->src_port; |
| hb_udp_params_fp->dst_port = lphb_conf_req->dst_port; |
| hb_udp_params_fp->interval = lphb_conf_req->interval; |
| hb_udp_params_fp->timeout = lphb_conf_req->timeout; |
| hb_udp_params_fp->session = lphb_conf_req->session; |
| qdf_mem_copy(&hb_udp_params_fp->gateway_mac, |
| &lphb_conf_req->gateway_mac, |
| sizeof(lphb_conf_req->gateway_mac)); |
| |
| wmi_mtrace(WMI_HB_SET_UDP_PARAMS_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_HB_SET_UDP_PARAMS_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd_send WMI_HB_SET_UDP_PARAMS returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_lphb_config_udp_pkt_filter_cmd_tlv() - configure udp pkt filter command |
| * @wmi_handle: wmi handle |
| * @lphb_conf_req: lphb config request |
| * |
| * Return: CDF status |
| */ |
| static |
| QDF_STATUS send_lphb_config_udp_pkt_filter_cmd_tlv(wmi_unified_t wmi_handle, |
| wmi_hb_set_udp_pkt_filter_cmd_fixed_param *lphb_conf_req) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| uint8_t *buf_ptr; |
| wmi_hb_set_udp_pkt_filter_cmd_fixed_param *hb_udp_filter_fp; |
| int len = sizeof(wmi_hb_set_udp_pkt_filter_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| hb_udp_filter_fp = |
| (wmi_hb_set_udp_pkt_filter_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&hb_udp_filter_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_hb_set_udp_pkt_filter_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_hb_set_udp_pkt_filter_cmd_fixed_param)); |
| |
| /* fill in values */ |
| hb_udp_filter_fp->vdev_id = lphb_conf_req->vdev_id; |
| hb_udp_filter_fp->length = lphb_conf_req->length; |
| hb_udp_filter_fp->offset = lphb_conf_req->offset; |
| hb_udp_filter_fp->session = lphb_conf_req->session; |
| memcpy((void *)&hb_udp_filter_fp->filter, |
| (void *)&lphb_conf_req->filter, |
| WMI_WLAN_HB_MAX_FILTER_SIZE); |
| |
| wmi_mtrace(WMI_HB_SET_UDP_PKT_FILTER_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_HB_SET_UDP_PKT_FILTER_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("cmd_send WMI_HB_SET_UDP_PKT_FILTER returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| #endif /* FEATURE_WLAN_LPHB */ |
| |
| static QDF_STATUS send_conf_hw_filter_cmd_tlv(wmi_unified_t wmi, |
| struct pmo_hw_filter_params *req) |
| { |
| QDF_STATUS status; |
| wmi_hw_data_filter_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| |
| if (!req) { |
| WMI_LOGE("req is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| wmi_buf = wmi_buf_alloc(wmi, sizeof(*cmd)); |
| if (!wmi_buf) { |
| WMI_LOGE(FL("Out of memory")); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_hw_data_filter_cmd_fixed_param *)wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_hw_data_filter_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_hw_data_filter_cmd_fixed_param)); |
| cmd->vdev_id = req->vdev_id; |
| cmd->enable = req->enable; |
| /* Set all modes in case of disable */ |
| if (!cmd->enable) |
| cmd->hw_filter_bitmap = ((uint32_t)~0U); |
| else |
| cmd->hw_filter_bitmap = req->mode_bitmap; |
| |
| WMI_LOGD("Send %s hw filter mode: 0x%X for vdev id %d", |
| req->enable ? "enable" : "disable", req->mode_bitmap, |
| req->vdev_id); |
| |
| wmi_mtrace(WMI_HW_DATA_FILTER_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi, wmi_buf, sizeof(*cmd), |
| WMI_HW_DATA_FILTER_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("Failed to configure hw filter"); |
| wmi_buf_free(wmi_buf); |
| } |
| |
| return status; |
| } |
| |
| #ifdef WLAN_FEATURE_PACKET_FILTERING |
| /** |
| * send_enable_disable_packet_filter_cmd_tlv() - enable/disable packet filter |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @enable: Flag to enable/disable packet filter |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_enable_disable_packet_filter_cmd_tlv( |
| wmi_unified_t wmi_handle, uint8_t vdev_id, bool enable) |
| { |
| int32_t len; |
| int ret = 0; |
| wmi_buf_t buf; |
| WMI_PACKET_FILTER_ENABLE_CMD_fixed_param *cmd; |
| |
| len = sizeof(WMI_PACKET_FILTER_ENABLE_CMD_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_PACKET_FILTER_ENABLE_CMD_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_packet_filter_enable_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| WMI_PACKET_FILTER_ENABLE_CMD_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| if (enable) |
| cmd->enable = PACKET_FILTER_SET_ENABLE; |
| else |
| cmd->enable = PACKET_FILTER_SET_DISABLE; |
| |
| WMI_LOGE("%s: Packet filter enable %d for vdev_id %d", |
| __func__, cmd->enable, vdev_id); |
| |
| wmi_mtrace(WMI_PACKET_FILTER_ENABLE_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PACKET_FILTER_ENABLE_CMDID); |
| if (ret) { |
| WMI_LOGE("Failed to send packet filter wmi cmd to fw"); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * send_config_packet_filter_cmd_tlv() - configure packet filter in target |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev id |
| * @rcv_filter_param: Packet filter parameters |
| * @filter_id: Filter id |
| * @enable: Flag to add/delete packet filter configuration |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS send_config_packet_filter_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t vdev_id, struct pmo_rcv_pkt_fltr_cfg *rcv_filter_param, |
| uint8_t filter_id, bool enable) |
| { |
| int len, i; |
| int err = 0; |
| wmi_buf_t buf; |
| WMI_PACKET_FILTER_CONFIG_CMD_fixed_param *cmd; |
| |
| |
| /* allocate the memory */ |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate buffer to send set_param cmd"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (WMI_PACKET_FILTER_CONFIG_CMD_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_packet_filter_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (WMI_PACKET_FILTER_CONFIG_CMD_fixed_param)); |
| |
| cmd->vdev_id = vdev_id; |
| cmd->filter_id = filter_id; |
| if (enable) |
| cmd->filter_action = PACKET_FILTER_SET_ACTIVE; |
| else |
| cmd->filter_action = PACKET_FILTER_SET_INACTIVE; |
| |
| if (enable) { |
| cmd->num_params = QDF_MIN( |
| WMI_PACKET_FILTER_MAX_CMP_PER_PACKET_FILTER, |
| rcv_filter_param->num_params); |
| cmd->filter_type = rcv_filter_param->filter_type; |
| cmd->coalesce_time = rcv_filter_param->coalesce_time; |
| |
| for (i = 0; i < cmd->num_params; i++) { |
| cmd->paramsData[i].proto_type = |
| rcv_filter_param->params_data[i].protocol_layer; |
| cmd->paramsData[i].cmp_type = |
| rcv_filter_param->params_data[i].compare_flag; |
| cmd->paramsData[i].data_length = |
| rcv_filter_param->params_data[i].data_length; |
| cmd->paramsData[i].data_offset = |
| rcv_filter_param->params_data[i].data_offset; |
| memcpy(&cmd->paramsData[i].compareData, |
| rcv_filter_param->params_data[i].compare_data, |
| sizeof(cmd->paramsData[i].compareData)); |
| memcpy(&cmd->paramsData[i].dataMask, |
| rcv_filter_param->params_data[i].data_mask, |
| sizeof(cmd->paramsData[i].dataMask)); |
| } |
| } |
| |
| WMI_LOGE("Packet filter action %d filter with id: %d, num_params=%d", |
| cmd->filter_action, cmd->filter_id, cmd->num_params); |
| /* send the command along with data */ |
| wmi_mtrace(WMI_PACKET_FILTER_CONFIG_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PACKET_FILTER_CONFIG_CMDID); |
| if (err) { |
| WMI_LOGE("Failed to send pkt_filter cmd"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif /* End of WLAN_FEATURE_PACKET_FILTERING */ |
| #endif /* End of WLAN_POWER_MANAGEMENT_OFFLOAD */ |
| |
| /** |
| * send_set_ssid_hotlist_cmd_tlv() - Handle an SSID hotlist set request |
| * @wmi_handle: wmi handle |
| * @request: SSID hotlist set request |
| * |
| * Return: QDF_STATUS enumeration |
| */ |
| static QDF_STATUS |
| send_set_ssid_hotlist_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ssid_hotlist_request_params *request) |
| { |
| wmi_extscan_configure_hotlist_ssid_monitor_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint32_t len; |
| uint32_t array_size; |
| uint8_t *buf_ptr; |
| |
| /* length of fixed portion */ |
| len = sizeof(*cmd); |
| |
| /* length of variable portion */ |
| array_size = |
| request->ssid_count * sizeof(wmi_extscan_hotlist_ssid_entry); |
| len += WMI_TLV_HDR_SIZE + array_size; |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(wmi_buf); |
| cmd = (wmi_extscan_configure_hotlist_ssid_monitor_cmd_fixed_param *) |
| buf_ptr; |
| WMITLV_SET_HDR |
| (&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_extscan_configure_hotlist_ssid_monitor_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_extscan_configure_hotlist_ssid_monitor_cmd_fixed_param)); |
| |
| cmd->request_id = request->request_id; |
| cmd->requestor_id = 0; |
| cmd->vdev_id = request->session_id; |
| cmd->table_id = 0; |
| cmd->lost_ap_scan_count = request->lost_ssid_sample_size; |
| cmd->total_entries = request->ssid_count; |
| cmd->num_entries_in_page = request->ssid_count; |
| cmd->first_entry_index = 0; |
| |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, array_size); |
| |
| if (request->ssid_count) { |
| wmi_extscan_hotlist_ssid_entry *entry; |
| int i; |
| |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| entry = (wmi_extscan_hotlist_ssid_entry *)buf_ptr; |
| for (i = 0; i < request->ssid_count; i++) { |
| WMITLV_SET_HDR |
| (entry, |
| WMITLV_TAG_ARRAY_STRUC, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_extscan_hotlist_ssid_entry)); |
| entry->ssid.ssid_len = request->ssids[i].ssid.length; |
| qdf_mem_copy(entry->ssid.ssid, |
| request->ssids[i].ssid.mac_ssid, |
| request->ssids[i].ssid.length); |
| entry->band = request->ssids[i].band; |
| entry->min_rssi = request->ssids[i].rssi_low; |
| entry->max_rssi = request->ssids[i].rssi_high; |
| entry++; |
| } |
| cmd->mode = WMI_EXTSCAN_MODE_START; |
| } else { |
| cmd->mode = WMI_EXTSCAN_MODE_STOP; |
| } |
| |
| wmi_mtrace(WMI_EXTSCAN_CONFIGURE_HOTLIST_SSID_MONITOR_CMDID, |
| cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send |
| (wmi_handle, wmi_buf, len, |
| WMI_EXTSCAN_CONFIGURE_HOTLIST_SSID_MONITOR_CMDID)) { |
| WMI_LOGE("%s: failed to send command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_fw_test_cmd_tlv() - send fw test command to fw. |
| * @wmi_handle: wmi handle |
| * @wmi_fwtest: fw test command |
| * |
| * This function sends fw test command to fw. |
| * |
| * Return: CDF STATUS |
| */ |
| static |
| QDF_STATUS send_fw_test_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_fwtest_params *wmi_fwtest) |
| { |
| wmi_fwtest_set_param_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint16_t len; |
| |
| len = sizeof(*cmd); |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmai_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_fwtest_set_param_cmd_fixed_param *) wmi_buf_data(wmi_buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_fwtest_set_param_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_fwtest_set_param_cmd_fixed_param)); |
| cmd->param_id = wmi_fwtest->arg; |
| cmd->param_value = wmi_fwtest->value; |
| |
| wmi_mtrace(WMI_FWTEST_CMDID, NO_SESSION, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_FWTEST_CMDID)) { |
| WMI_LOGP("%s: failed to send fw test command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_unit_test_cmd_tlv() - send unit test command to fw. |
| * @wmi_handle: wmi handle |
| * @wmi_utest: unit test command |
| * |
| * This function send unit test command to fw. |
| * |
| * Return: CDF STATUS |
| */ |
| static QDF_STATUS send_unit_test_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_unit_test_cmd *wmi_utest) |
| { |
| wmi_unit_test_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| uint8_t *buf_ptr; |
| int i; |
| uint16_t len, args_tlv_len; |
| uint32_t *unit_test_cmd_args; |
| |
| args_tlv_len = |
| WMI_TLV_HDR_SIZE + wmi_utest->num_args * sizeof(uint32_t); |
| len = sizeof(wmi_unit_test_cmd_fixed_param) + args_tlv_len; |
| |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmai_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_unit_test_cmd_fixed_param *) wmi_buf_data(wmi_buf); |
| buf_ptr = (uint8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_unit_test_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_unit_test_cmd_fixed_param)); |
| cmd->vdev_id = wmi_utest->vdev_id; |
| cmd->module_id = wmi_utest->module_id; |
| cmd->num_args = wmi_utest->num_args; |
| cmd->diag_token = wmi_utest->diag_token; |
| buf_ptr += sizeof(wmi_unit_test_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (wmi_utest->num_args * sizeof(uint32_t))); |
| unit_test_cmd_args = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| WMI_LOGI("%s: VDEV ID: %d\n", __func__, cmd->vdev_id); |
| WMI_LOGI("%s: MODULE ID: %d\n", __func__, cmd->module_id); |
| WMI_LOGI("%s: TOKEN: %d\n", __func__, cmd->diag_token); |
| WMI_LOGI("%s: %d num of args = ", __func__, wmi_utest->num_args); |
| for (i = 0; (i < wmi_utest->num_args && i < WMI_UNIT_TEST_MAX_NUM_ARGS); i++) { |
| unit_test_cmd_args[i] = wmi_utest->args[i]; |
| WMI_LOGI("%d,", wmi_utest->args[i]); |
| } |
| wmi_mtrace(WMI_UNIT_TEST_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_UNIT_TEST_CMDID)) { |
| WMI_LOGP("%s: failed to send unit test command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_roam_invoke_cmd_tlv() - send roam invoke command to fw. |
| * @wmi_handle: wma handle |
| * @roaminvoke: roam invoke command |
| * |
| * Send roam invoke command to fw for fastreassoc. |
| * |
| * Return: CDF STATUS |
| */ |
| static QDF_STATUS send_roam_invoke_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_roam_invoke_cmd *roaminvoke, |
| uint32_t ch_hz) |
| { |
| wmi_roam_invoke_cmd_fixed_param *cmd; |
| wmi_buf_t wmi_buf; |
| u_int8_t *buf_ptr; |
| u_int16_t len, args_tlv_len; |
| uint32_t *channel_list; |
| wmi_mac_addr *bssid_list; |
| wmi_tlv_buf_len_param *buf_len_tlv; |
| |
| /* Host sends only one channel and one bssid */ |
| args_tlv_len = (4 * WMI_TLV_HDR_SIZE) + sizeof(uint32_t) + |
| sizeof(wmi_mac_addr) + sizeof(wmi_tlv_buf_len_param) + |
| roundup(roaminvoke->frame_len, sizeof(uint32_t)); |
| len = sizeof(wmi_roam_invoke_cmd_fixed_param) + args_tlv_len; |
| wmi_buf = wmi_buf_alloc(wmi_handle, len); |
| if (!wmi_buf) { |
| WMI_LOGE("%s: wmai_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_roam_invoke_cmd_fixed_param *)wmi_buf_data(wmi_buf); |
| buf_ptr = (u_int8_t *) cmd; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_invoke_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_roam_invoke_cmd_fixed_param)); |
| cmd->vdev_id = roaminvoke->vdev_id; |
| cmd->flags |= (1 << WMI_ROAM_INVOKE_FLAG_REPORT_FAILURE); |
| if (roaminvoke->is_same_bssid) |
| cmd->flags |= (1 << WMI_ROAM_INVOKE_FLAG_NO_NULL_FRAME_TO_AP); |
| WMI_LOGD(FL("is_same_bssid flag: %d"), roaminvoke->is_same_bssid); |
| |
| if (roaminvoke->frame_len) { |
| cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_SKIP; |
| /* packing 1 beacon/probe_rsp frame with WMI cmd */ |
| cmd->num_buf = 1; |
| } else { |
| cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_FIXED_CH; |
| cmd->num_buf = 0; |
| } |
| |
| cmd->roam_ap_sel_mode = 0; |
| cmd->roam_delay = 0; |
| cmd->num_chan = 1; |
| cmd->num_bssid = 1; |
| |
| buf_ptr += sizeof(wmi_roam_invoke_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (sizeof(u_int32_t))); |
| channel_list = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| *channel_list = ch_hz; |
| buf_ptr += sizeof(uint32_t) + WMI_TLV_HDR_SIZE; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (sizeof(wmi_mac_addr))); |
| bssid_list = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(roaminvoke->bssid, bssid_list); |
| |
| /* move to next tlv i.e. bcn_prb_buf_list */ |
| buf_ptr += WMI_TLV_HDR_SIZE + sizeof(wmi_mac_addr); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC, |
| sizeof(wmi_tlv_buf_len_param)); |
| |
| buf_len_tlv = (wmi_tlv_buf_len_param *)(buf_ptr + WMI_TLV_HDR_SIZE); |
| buf_len_tlv->buf_len = roaminvoke->frame_len; |
| |
| /* move to next tlv i.e. bcn_prb_frm */ |
| buf_ptr += WMI_TLV_HDR_SIZE + sizeof(wmi_tlv_buf_len_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, |
| roundup(roaminvoke->frame_len, sizeof(uint32_t))); |
| |
| /* copy frame after the header */ |
| qdf_mem_copy(buf_ptr + WMI_TLV_HDR_SIZE, |
| roaminvoke->frame_buf, |
| roaminvoke->frame_len); |
| |
| WMI_LOGD(FL("bcn/prb_rsp frame, length: %d"), roaminvoke->frame_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| buf_ptr + WMI_TLV_HDR_SIZE, |
| roaminvoke->frame_len); |
| WMI_LOGD(FL("flag:%d, MODE scn:%d, ap:%d, dly:%d, n_ch:%d, n_bssid:%d"), |
| cmd->flags, cmd->roam_scan_mode, |
| cmd->roam_ap_sel_mode, cmd->roam_delay, |
| cmd->num_chan, cmd->num_bssid); |
| WMI_LOGD(FL("BSSID: %pM, channel: %d"), roaminvoke->bssid, ch_hz); |
| |
| wmi_mtrace(WMI_ROAM_INVOKE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len, |
| WMI_ROAM_INVOKE_CMDID)) { |
| WMI_LOGP("%s: failed to send roam invoke command", __func__); |
| wmi_buf_free(wmi_buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_roam_scan_offload_cmd_tlv() - set roam offload command |
| * @wmi_handle: wmi handle |
| * @command: command |
| * @vdev_id: vdev id |
| * |
| * This function set roam offload command to fw. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t command, uint32_t vdev_id) |
| { |
| QDF_STATUS status; |
| wmi_roam_scan_cmd_fixed_param *cmd_fp; |
| wmi_buf_t buf = NULL; |
| int len; |
| uint8_t *buf_ptr; |
| |
| len = sizeof(wmi_roam_scan_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| |
| cmd_fp = (wmi_roam_scan_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_scan_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_roam_scan_cmd_fixed_param)); |
| cmd_fp->vdev_id = vdev_id; |
| cmd_fp->command_arg = command; |
| |
| wmi_mtrace(WMI_ROAM_SCAN_CMD, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_SCAN_CMD); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_ROAM_SCAN_CMD returned Error %d", |
| status); |
| goto error; |
| } |
| |
| WMI_LOGI("%s: WMI --> WMI_ROAM_SCAN_CMD", __func__); |
| return QDF_STATUS_SUCCESS; |
| |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_roam_scan_offload_ap_profile_cmd_tlv() - set roam ap profile in fw |
| * @wmi_handle: wmi handle |
| * @ap_profile_p: ap profile |
| * @vdev_id: vdev id |
| * |
| * Send WMI_ROAM_AP_PROFILE to firmware |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_ap_profile_cmd_tlv(wmi_unified_t wmi_handle, |
| struct ap_profile_params *ap_profile) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_ap_profile_fixed_param *roam_ap_profile_fp; |
| wmi_roam_cnd_scoring_param *score_param; |
| wmi_ap_profile *profile; |
| |
| len = sizeof(wmi_roam_ap_profile_fixed_param) + sizeof(wmi_ap_profile); |
| len += sizeof(*score_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| roam_ap_profile_fp = (wmi_roam_ap_profile_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&roam_ap_profile_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_ap_profile_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_ap_profile_fixed_param)); |
| /* fill in threshold values */ |
| roam_ap_profile_fp->vdev_id = ap_profile->vdev_id; |
| roam_ap_profile_fp->id = 0; |
| buf_ptr += sizeof(wmi_roam_ap_profile_fixed_param); |
| |
| profile = (wmi_ap_profile *)buf_ptr; |
| WMITLV_SET_HDR(&profile->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ap_profile, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ap_profile)); |
| profile->flags = ap_profile->profile.flags; |
| profile->rssi_threshold = ap_profile->profile.rssi_threshold; |
| profile->ssid.ssid_len = ap_profile->profile.ssid.length; |
| qdf_mem_copy(profile->ssid.ssid, ap_profile->profile.ssid.mac_ssid, |
| profile->ssid.ssid_len); |
| profile->rsn_authmode = ap_profile->profile.rsn_authmode; |
| profile->rsn_ucastcipherset = ap_profile->profile.rsn_ucastcipherset; |
| profile->rsn_mcastcipherset = ap_profile->profile.rsn_mcastcipherset; |
| profile->rsn_mcastmgmtcipherset = |
| ap_profile->profile.rsn_mcastmgmtcipherset; |
| profile->rssi_abs_thresh = ap_profile->profile.rssi_abs_thresh; |
| |
| WMI_LOGD("AP profile: flags %x rssi_threshold %d ssid:%.*s authmode %d uc cipher %d mc cipher %d mc mgmt cipher %d rssi abs thresh %d", |
| profile->flags, profile->rssi_threshold, |
| profile->ssid.ssid_len, ap_profile->profile.ssid.mac_ssid, |
| profile->rsn_authmode, profile->rsn_ucastcipherset, |
| profile->rsn_mcastcipherset, profile->rsn_mcastmgmtcipherset, |
| profile->rssi_abs_thresh); |
| |
| buf_ptr += sizeof(wmi_ap_profile); |
| |
| score_param = (wmi_roam_cnd_scoring_param *)buf_ptr; |
| WMITLV_SET_HDR(&score_param->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_cnd_scoring_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_scoring_param)); |
| score_param->disable_bitmap = ap_profile->param.disable_bitmap; |
| score_param->rssi_weightage_pcnt = |
| ap_profile->param.rssi_weightage; |
| score_param->ht_weightage_pcnt = ap_profile->param.ht_weightage; |
| score_param->vht_weightage_pcnt = ap_profile->param.vht_weightage; |
| score_param->he_weightage_pcnt = ap_profile->param.he_weightage; |
| score_param->bw_weightage_pcnt = ap_profile->param.bw_weightage; |
| score_param->band_weightage_pcnt = ap_profile->param.band_weightage; |
| score_param->nss_weightage_pcnt = ap_profile->param.nss_weightage; |
| score_param->esp_qbss_weightage_pcnt = |
| ap_profile->param.esp_qbss_weightage; |
| score_param->beamforming_weightage_pcnt = |
| ap_profile->param.beamforming_weightage; |
| score_param->pcl_weightage_pcnt = ap_profile->param.pcl_weightage; |
| score_param->oce_wan_weightage_pcnt = |
| ap_profile->param.oce_wan_weightage; |
| |
| WMI_LOGD("Score params weightage: disable_bitmap %x rssi %d ht %d vht %d he %d BW %d band %d NSS %d ESP %d BF %d PCL %d OCE WAN %d", |
| score_param->disable_bitmap, score_param->rssi_weightage_pcnt, |
| score_param->ht_weightage_pcnt, |
| score_param->vht_weightage_pcnt, |
| score_param->he_weightage_pcnt, score_param->bw_weightage_pcnt, |
| score_param->band_weightage_pcnt, |
| score_param->nss_weightage_pcnt, |
| score_param->esp_qbss_weightage_pcnt, |
| score_param->beamforming_weightage_pcnt, |
| score_param->pcl_weightage_pcnt, |
| score_param->oce_wan_weightage_pcnt); |
| |
| score_param->bw_scoring.score_pcnt = ap_profile->param.bw_index_score; |
| score_param->band_scoring.score_pcnt = |
| ap_profile->param.band_index_score; |
| score_param->nss_scoring.score_pcnt = |
| ap_profile->param.nss_index_score; |
| |
| WMI_LOGD("Params index score bitmask: bw_index_score %x band_index_score %x nss_index_score %x", |
| score_param->bw_scoring.score_pcnt, |
| score_param->band_scoring.score_pcnt, |
| score_param->nss_scoring.score_pcnt); |
| |
| score_param->rssi_scoring.best_rssi_threshold = |
| (-1) * ap_profile->param.rssi_scoring.best_rssi_threshold; |
| score_param->rssi_scoring.good_rssi_threshold = |
| (-1) * ap_profile->param.rssi_scoring.good_rssi_threshold; |
| score_param->rssi_scoring.bad_rssi_threshold = |
| (-1) * ap_profile->param.rssi_scoring.bad_rssi_threshold; |
| score_param->rssi_scoring.good_rssi_pcnt = |
| ap_profile->param.rssi_scoring.good_rssi_pcnt; |
| score_param->rssi_scoring.bad_rssi_pcnt = |
| ap_profile->param.rssi_scoring.bad_rssi_pcnt; |
| score_param->rssi_scoring.good_bucket_size = |
| ap_profile->param.rssi_scoring.good_bucket_size; |
| score_param->rssi_scoring.bad_bucket_size = |
| ap_profile->param.rssi_scoring.bad_bucket_size; |
| score_param->rssi_scoring.rssi_pref_5g_rssi_thresh = |
| (-1) * ap_profile->param.rssi_scoring.rssi_pref_5g_rssi_thresh; |
| |
| WMI_LOGD("Rssi scoring threshold: best RSSI %d good RSSI %d bad RSSI %d prefer 5g threshold %d", |
| score_param->rssi_scoring.best_rssi_threshold, |
| score_param->rssi_scoring.good_rssi_threshold, |
| score_param->rssi_scoring.bad_rssi_threshold, |
| score_param->rssi_scoring.rssi_pref_5g_rssi_thresh); |
| WMI_LOGD("Good RSSI score for each slot %d bad RSSI score for each slot %d good bucket %d bad bucket %d", |
| score_param->rssi_scoring.good_rssi_pcnt, |
| score_param->rssi_scoring.bad_rssi_pcnt, |
| score_param->rssi_scoring.good_bucket_size, |
| score_param->rssi_scoring.bad_bucket_size); |
| |
| score_param->esp_qbss_scoring.num_slot = |
| ap_profile->param.esp_qbss_scoring.num_slot; |
| score_param->esp_qbss_scoring.score_pcnt3_to_0 = |
| ap_profile->param.esp_qbss_scoring.score_pcnt3_to_0; |
| score_param->esp_qbss_scoring.score_pcnt7_to_4 = |
| ap_profile->param.esp_qbss_scoring.score_pcnt7_to_4; |
| score_param->esp_qbss_scoring.score_pcnt11_to_8 = |
| ap_profile->param.esp_qbss_scoring.score_pcnt11_to_8; |
| score_param->esp_qbss_scoring.score_pcnt15_to_12 = |
| ap_profile->param.esp_qbss_scoring.score_pcnt15_to_12; |
| |
| WMI_LOGD("ESP QBSS index weight: slots %d weight 0to3 %x weight 4to7 %x weight 8to11 %x weight 12to15 %x", |
| score_param->esp_qbss_scoring.num_slot, |
| score_param->esp_qbss_scoring.score_pcnt3_to_0, |
| score_param->esp_qbss_scoring.score_pcnt7_to_4, |
| score_param->esp_qbss_scoring.score_pcnt11_to_8, |
| score_param->esp_qbss_scoring.score_pcnt15_to_12); |
| |
| score_param->oce_wan_scoring.num_slot = |
| ap_profile->param.oce_wan_scoring.num_slot; |
| score_param->oce_wan_scoring.score_pcnt3_to_0 = |
| ap_profile->param.oce_wan_scoring.score_pcnt3_to_0; |
| score_param->oce_wan_scoring.score_pcnt7_to_4 = |
| ap_profile->param.oce_wan_scoring.score_pcnt7_to_4; |
| score_param->oce_wan_scoring.score_pcnt11_to_8 = |
| ap_profile->param.oce_wan_scoring.score_pcnt11_to_8; |
| score_param->oce_wan_scoring.score_pcnt15_to_12 = |
| ap_profile->param.oce_wan_scoring.score_pcnt15_to_12; |
| |
| WMI_LOGD("OCE WAN index weight: slots %d weight 0to3 %x weight 4to7 %x weight 8to11 %x weight 12to15 %x", |
| score_param->oce_wan_scoring.num_slot, |
| score_param->oce_wan_scoring.score_pcnt3_to_0, |
| score_param->oce_wan_scoring.score_pcnt7_to_4, |
| score_param->oce_wan_scoring.score_pcnt11_to_8, |
| score_param->oce_wan_scoring.score_pcnt15_to_12); |
| |
| wmi_mtrace(WMI_ROAM_AP_PROFILE, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_AP_PROFILE); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_ROAM_AP_PROFILE returned Error %d", |
| status); |
| wmi_buf_free(buf); |
| } |
| |
| WMI_LOGD("WMI --> WMI_ROAM_AP_PROFILE and other parameters"); |
| |
| return status; |
| } |
| |
| /** |
| * send_roam_scan_offload_scan_period_cmd_tlv() - set roam offload scan period |
| * @wmi_handle: wmi handle |
| * @scan_period: scan period |
| * @scan_age: scan age |
| * @vdev_id: vdev id |
| * |
| * Send WMI_ROAM_SCAN_PERIOD parameters to fw. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_scan_period_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t scan_period, |
| uint32_t scan_age, |
| uint32_t vdev_id) |
| { |
| QDF_STATUS status; |
| wmi_buf_t buf = NULL; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_scan_period_fixed_param *scan_period_fp; |
| |
| /* Send scan period values */ |
| len = sizeof(wmi_roam_scan_period_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| scan_period_fp = (wmi_roam_scan_period_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&scan_period_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_scan_period_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_scan_period_fixed_param)); |
| /* fill in scan period values */ |
| scan_period_fp->vdev_id = vdev_id; |
| scan_period_fp->roam_scan_period = scan_period; /* 20 seconds */ |
| scan_period_fp->roam_scan_age = scan_age; |
| |
| wmi_mtrace(WMI_ROAM_SCAN_PERIOD, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_SCAN_PERIOD); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_ROAM_SCAN_PERIOD returned Error %d", |
| status); |
| goto error; |
| } |
| |
| WMI_LOGI("%s: WMI --> WMI_ROAM_SCAN_PERIOD roam_scan_period=%d, roam_scan_age=%d", |
| __func__, scan_period, scan_age); |
| return QDF_STATUS_SUCCESS; |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_roam_scan_offload_chan_list_cmd_tlv() - set roam offload channel list |
| * @wmi_handle: wmi handle |
| * @chan_count: channel count |
| * @chan_list: channel list |
| * @list_type: list type |
| * @vdev_id: vdev id |
| * |
| * Set roam offload channel list. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_chan_list_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t chan_count, |
| uint32_t *chan_list, |
| uint8_t list_type, uint32_t vdev_id) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len, list_tlv_len; |
| int i; |
| uint8_t *buf_ptr; |
| wmi_roam_chan_list_fixed_param *chan_list_fp; |
| uint32_t *roam_chan_list_array; |
| |
| if (chan_count == 0) { |
| WMI_LOGD("%s : invalid number of channels %d", __func__, |
| chan_count); |
| return QDF_STATUS_E_EMPTY; |
| } |
| /* Channel list is a table of 2 TLV's */ |
| list_tlv_len = WMI_TLV_HDR_SIZE + chan_count * sizeof(uint32_t); |
| len = sizeof(wmi_roam_chan_list_fixed_param) + list_tlv_len; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| chan_list_fp = (wmi_roam_chan_list_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&chan_list_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_chan_list_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_chan_list_fixed_param)); |
| chan_list_fp->vdev_id = vdev_id; |
| chan_list_fp->num_chan = chan_count; |
| if (chan_count > 0 && list_type == WMI_CHANNEL_LIST_STATIC) { |
| /* external app is controlling channel list */ |
| chan_list_fp->chan_list_type = |
| WMI_ROAM_SCAN_CHAN_LIST_TYPE_STATIC; |
| } else { |
| /* umac supplied occupied channel list in LFR */ |
| chan_list_fp->chan_list_type = |
| WMI_ROAM_SCAN_CHAN_LIST_TYPE_DYNAMIC; |
| } |
| |
| buf_ptr += sizeof(wmi_roam_chan_list_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (chan_list_fp->num_chan * sizeof(uint32_t))); |
| roam_chan_list_array = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| WMI_LOGD("%s: %d channels = ", __func__, chan_list_fp->num_chan); |
| for (i = 0; ((i < chan_list_fp->num_chan) && |
| (i < WMI_ROAM_MAX_CHANNELS)); i++) { |
| roam_chan_list_array[i] = chan_list[i]; |
| WMI_LOGD("%d,", roam_chan_list_array[i]); |
| } |
| |
| wmi_mtrace(WMI_ROAM_CHAN_LIST, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_CHAN_LIST); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_ROAM_CHAN_LIST returned Error %d", |
| status); |
| goto error; |
| } |
| |
| WMI_LOGD("%s: WMI --> WMI_ROAM_SCAN_CHAN_LIST", __func__); |
| return QDF_STATUS_SUCCESS; |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_per_roam_config_cmd_tlv() - set per roaming config to FW |
| * @wmi_handle: wmi handle |
| * @req_buf: per roam config buffer |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_per_roam_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_per_roam_config_req *req_buf) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_per_config_fixed_param *wmi_per_config; |
| |
| len = sizeof(wmi_roam_per_config_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| wmi_per_config = |
| (wmi_roam_per_config_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&wmi_per_config->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_per_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_per_config_fixed_param)); |
| |
| /* fill in per roam config values */ |
| wmi_per_config->vdev_id = req_buf->vdev_id; |
| |
| wmi_per_config->enable = req_buf->per_config.enable; |
| wmi_per_config->high_rate_thresh = |
| (req_buf->per_config.tx_high_rate_thresh << 16) | |
| (req_buf->per_config.rx_high_rate_thresh & 0x0000ffff); |
| wmi_per_config->low_rate_thresh = |
| (req_buf->per_config.tx_low_rate_thresh << 16) | |
| (req_buf->per_config.rx_low_rate_thresh & 0x0000ffff); |
| wmi_per_config->pkt_err_rate_thresh_pct = |
| (req_buf->per_config.tx_rate_thresh_percnt << 16) | |
| (req_buf->per_config.rx_rate_thresh_percnt & 0x0000ffff); |
| wmi_per_config->per_rest_time = req_buf->per_config.per_rest_time; |
| wmi_per_config->pkt_err_rate_mon_time = |
| (req_buf->per_config.tx_per_mon_time << 16) | |
| (req_buf->per_config.rx_per_mon_time & 0x0000ffff); |
| wmi_per_config->min_candidate_rssi = |
| req_buf->per_config.min_candidate_rssi; |
| |
| /* Send per roam config parameters */ |
| wmi_mtrace(WMI_ROAM_PER_CONFIG_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_PER_CONFIG_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_ROAM_PER_CONFIG_CMDID failed, Error %d", |
| status); |
| wmi_buf_free(buf); |
| return status; |
| } |
| WMI_LOGD(FL("per roam enable=%d, vdev=%d"), |
| req_buf->per_config.enable, req_buf->vdev_id); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_roam_scan_offload_rssi_change_cmd_tlv() - set roam offload RSSI th |
| * @wmi_handle: wmi handle |
| * @rssi_change_thresh: RSSI Change threshold |
| * @bcn_rssi_weight: beacon RSSI weight |
| * @vdev_id: vdev id |
| * |
| * Send WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD parameters to fw. |
| * |
| * Return: CDF status |
| */ |
| static QDF_STATUS send_roam_scan_offload_rssi_change_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t vdev_id, |
| int32_t rssi_change_thresh, |
| uint32_t bcn_rssi_weight, |
| uint32_t hirssi_delay_btw_scans) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_roam_scan_rssi_change_threshold_fixed_param *rssi_change_fp; |
| |
| /* Send rssi change parameters */ |
| len = sizeof(wmi_roam_scan_rssi_change_threshold_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| rssi_change_fp = |
| (wmi_roam_scan_rssi_change_threshold_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&rssi_change_fp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_roam_scan_rssi_change_threshold_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_roam_scan_rssi_change_threshold_fixed_param)); |
| /* fill in rssi change threshold (hysteresis) values */ |
| rssi_change_fp->vdev_id = vdev_id; |
| rssi_change_fp->roam_scan_rssi_change_thresh = rssi_change_thresh; |
| rssi_change_fp->bcn_rssi_weight = bcn_rssi_weight; |
| rssi_change_fp->hirssi_delay_btw_scans = hirssi_delay_btw_scans; |
| |
| wmi_mtrace(WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD returned Error %d", |
| status); |
| goto error; |
| } |
| |
| WMI_LOGD(FL("roam_scan_rssi_change_thresh=%d, bcn_rssi_weight=%d"), |
| rssi_change_thresh, bcn_rssi_weight); |
| WMI_LOGD(FL("hirssi_delay_btw_scans=%d"), hirssi_delay_btw_scans); |
| return QDF_STATUS_SUCCESS; |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_power_dbg_cmd_tlv() - send power debug commands |
| * @wmi_handle: wmi handle |
| * @param: wmi power debug parameter |
| * |
| * Send WMI_POWER_DEBUG_CMDID parameters to fw. |
| * |
| * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error |
| */ |
| static QDF_STATUS send_power_dbg_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_power_dbg_params *param) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len, args_tlv_len; |
| uint8_t *buf_ptr; |
| uint8_t i; |
| wmi_pdev_wal_power_debug_cmd_fixed_param *cmd; |
| uint32_t *cmd_args; |
| |
| /* Prepare and send power debug cmd parameters */ |
| args_tlv_len = WMI_TLV_HDR_SIZE + param->num_args * sizeof(uint32_t); |
| len = sizeof(*cmd) + args_tlv_len; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_pdev_wal_power_debug_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_wal_power_debug_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pdev_wal_power_debug_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target( |
| param->pdev_id); |
| cmd->module_id = param->module_id; |
| cmd->num_args = param->num_args; |
| buf_ptr += sizeof(*cmd); |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32, |
| (param->num_args * sizeof(uint32_t))); |
| cmd_args = (uint32_t *) (buf_ptr + WMI_TLV_HDR_SIZE); |
| WMI_LOGI("%s: %d num of args = ", __func__, param->num_args); |
| for (i = 0; (i < param->num_args && i < WMI_MAX_POWER_DBG_ARGS); i++) { |
| cmd_args[i] = param->args[i]; |
| WMI_LOGI("%d,", param->args[i]); |
| } |
| |
| wmi_mtrace(WMI_PDEV_WAL_POWER_DEBUG_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_PDEV_WAL_POWER_DEBUG_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_PDEV_WAL_POWER_DEBUG_CMDID returned Error %d", |
| status); |
| goto error; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * 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; |
| wmi_channel *chan_info; |
| struct channel_param *tchan_info; |
| uint16_t len = sizeof(*cmd) + WMI_TLV_HDR_SIZE; |
| |
| len += sizeof(wmi_channel); |
| if (param->num_vdevs) |
| len += sizeof(uint32_t) * param->num_vdevs; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate memory\n"); |
| 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( |
| 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->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); |
| |
| 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\n", __func__); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| return qdf_status; |
| } |
| |
| /** |
| * send_dfs_phyerr_offload_en_cmd_tlv() - send dfs phyerr offload enable cmd |
| * @wmi_handle: wmi handle |
| * @pdev_id: pdev id |
| * |
| * Send WMI_PDEV_DFS_PHYERR_OFFLOAD_ENABLE_CMDID command to firmware. |
| * |
| * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error |
| */ |
| static QDF_STATUS send_dfs_phyerr_offload_en_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t pdev_id) |
| { |
| wmi_pdev_dfs_phyerr_offload_enable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len; |
| QDF_STATUS ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| WMI_LOGI("%s: pdev_id=%d", __func__, pdev_id); |
| |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_pdev_dfs_phyerr_offload_enable_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_dfs_phyerr_offload_enable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_dfs_phyerr_offload_enable_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(pdev_id); |
| wmi_mtrace(WMI_PDEV_DFS_PHYERR_OFFLOAD_ENABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_DFS_PHYERR_OFFLOAD_ENABLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send cmd to fw, ret=%d, pdev_id=%d", |
| __func__, ret, pdev_id); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_dfs_phyerr_offload_dis_cmd_tlv() - send dfs phyerr offload disable cmd |
| * @wmi_handle: wmi handle |
| * @pdev_id: pdev id |
| * |
| * Send WMI_PDEV_DFS_PHYERR_OFFLOAD_DISABLE_CMDID command to firmware. |
| * |
| * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error |
| */ |
| static QDF_STATUS send_dfs_phyerr_offload_dis_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t pdev_id) |
| { |
| wmi_pdev_dfs_phyerr_offload_disable_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len; |
| QDF_STATUS ret; |
| |
| len = sizeof(*cmd); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| |
| WMI_LOGI("%s: pdev_id=%d", __func__, pdev_id); |
| |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_pdev_dfs_phyerr_offload_disable_cmd_fixed_param *) |
| wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_dfs_phyerr_offload_disable_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_dfs_phyerr_offload_disable_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(pdev_id); |
| wmi_mtrace(WMI_PDEV_DFS_PHYERR_OFFLOAD_DISABLE_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_DFS_PHYERR_OFFLOAD_DISABLE_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send cmd to fw, ret=%d, pdev_id=%d", |
| __func__, ret, pdev_id); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * init_cmd_send_tlv() - send initialization cmd to fw |
| * @wmi_handle: wmi handle |
| * @param param: pointer to wmi init param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS init_cmd_send_tlv(wmi_unified_t wmi_handle, |
| struct wmi_init_cmd_param *param) |
| { |
| wmi_buf_t buf; |
| wmi_init_cmd_fixed_param *cmd; |
| uint8_t *buf_ptr; |
| wmi_resource_config *resource_cfg; |
| wlan_host_memory_chunk *host_mem_chunks; |
| uint32_t mem_chunk_len = 0, hw_mode_len = 0; |
| uint16_t idx; |
| int len; |
| QDF_STATUS ret; |
| |
| len = sizeof(*cmd) + sizeof(wmi_resource_config) + |
| WMI_TLV_HDR_SIZE; |
| mem_chunk_len = (sizeof(wlan_host_memory_chunk) * MAX_MEM_CHUNKS); |
| |
| if (param->hw_mode_id != WMI_HOST_HW_MODE_MAX) |
| hw_mode_len = sizeof(wmi_pdev_set_hw_mode_cmd_fixed_param) + |
| WMI_TLV_HDR_SIZE + |
| (param->num_band_to_mac * sizeof(wmi_pdev_band_to_mac)); |
| |
| buf = wmi_buf_alloc(wmi_handle, len + mem_chunk_len + hw_mode_len); |
| if (!buf) { |
| qdf_print("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_init_cmd_fixed_param *) buf_ptr; |
| resource_cfg = (wmi_resource_config *) (buf_ptr + sizeof(*cmd)); |
| |
| host_mem_chunks = (wlan_host_memory_chunk *) |
| (buf_ptr + sizeof(*cmd) + sizeof(wmi_resource_config) |
| + WMI_TLV_HDR_SIZE); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_init_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_init_cmd_fixed_param)); |
| |
| wmi_copy_resource_config(resource_cfg, param->res_cfg); |
| WMITLV_SET_HDR(&resource_cfg->tlv_header, |
| WMITLV_TAG_STRUC_wmi_resource_config, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_resource_config)); |
| |
| for (idx = 0; idx < param->num_mem_chunks; ++idx) { |
| WMITLV_SET_HDR(&(host_mem_chunks[idx].tlv_header), |
| WMITLV_TAG_STRUC_wlan_host_memory_chunk, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wlan_host_memory_chunk)); |
| host_mem_chunks[idx].ptr = param->mem_chunks[idx].paddr; |
| host_mem_chunks[idx].size = param->mem_chunks[idx].len; |
| host_mem_chunks[idx].req_id = param->mem_chunks[idx].req_id; |
| QDF_TRACE(QDF_MODULE_ID_ANY, QDF_TRACE_LEVEL_DEBUG, |
| "chunk %d len %d requested ,ptr 0x%x ", |
| idx, host_mem_chunks[idx].size, |
| host_mem_chunks[idx].ptr); |
| } |
| cmd->num_host_mem_chunks = param->num_mem_chunks; |
| len += (param->num_mem_chunks * sizeof(wlan_host_memory_chunk)); |
| |
| WMITLV_SET_HDR((buf_ptr + sizeof(*cmd) + sizeof(wmi_resource_config)), |
| WMITLV_TAG_ARRAY_STRUC, |
| (sizeof(wlan_host_memory_chunk) * |
| param->num_mem_chunks)); |
| |
| /* Fill hw mode id config */ |
| buf_ptr = copy_hw_mode_in_init_cmd(wmi_handle, buf_ptr, &len, param); |
| |
| /* Fill fw_abi_vers */ |
| copy_fw_abi_version_tlv(wmi_handle, cmd); |
| |
| wmi_mtrace(WMI_INIT_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, WMI_INIT_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("wmi_unified_cmd_send WMI_INIT_CMDID returned Error %d", |
| ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| |
| } |
| |
| /** |
| * send_addba_send_cmd_tlv() - send addba send command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to delba send params |
| * @macaddr: peer mac address |
| * |
| * Send WMI_ADDBA_SEND_CMDID command to firmware |
| * Return: QDF_STATUS_SUCCESS on success. QDF_STATUS_E** on error |
| */ |
| static QDF_STATUS |
| send_addba_send_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct addba_send_params *param) |
| { |
| wmi_addba_send_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_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_NOMEM; |
| } |
| |
| cmd = (wmi_addba_send_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_addba_send_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_addba_send_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| cmd->tid = param->tidno; |
| cmd->buffersize = param->buffersize; |
| |
| wmi_mtrace(WMI_ADDBA_SEND_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, WMI_ADDBA_SEND_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send cmd to fw, ret=%d", __func__, ret); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_delba_send_cmd_tlv() - send delba send command to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to delba send params |
| * @macaddr: peer mac address |
| * |
| * Send WMI_DELBA_SEND_CMDID command to firmware |
| * Return: QDF_STATUS_SUCCESS on success. QDF_STATUS_E** on error |
| */ |
| static QDF_STATUS |
| send_delba_send_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct delba_send_params *param) |
| { |
| wmi_delba_send_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_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_NOMEM; |
| } |
| |
| cmd = (wmi_delba_send_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_delba_send_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_delba_send_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| cmd->tid = param->tidno; |
| cmd->initiator = param->initiator; |
| cmd->reasoncode = param->reasoncode; |
| |
| wmi_mtrace(WMI_DELBA_SEND_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, WMI_DELBA_SEND_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send cmd to fw, ret=%d", __func__, ret); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_addba_clearresponse_cmd_tlv() - send addba clear response command |
| * to fw |
| * @wmi_handle: wmi handle |
| * @param: pointer to addba clearresp params |
| * @macaddr: peer mac address |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| send_addba_clearresponse_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t macaddr[IEEE80211_ADDR_LEN], |
| struct addba_clearresponse_params *param) |
| { |
| wmi_addba_clear_resp_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint16_t len; |
| QDF_STATUS ret; |
| |
| len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: wmi_buf_alloc failed\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| cmd = (wmi_addba_clear_resp_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_addba_clear_resp_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_addba_clear_resp_cmd_fixed_param)); |
| |
| cmd->vdev_id = param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr); |
| |
| wmi_mtrace(WMI_ADDBA_CLEAR_RESP_CMDID, cmd->vdev_id, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, |
| buf, len, WMI_ADDBA_CLEAR_RESP_CMDID); |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE("%s: Failed to send cmd to fw, ret=%d", __func__, ret); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * 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; |
| } |
| |
| #ifdef OBSS_PD |
| /** |
| * send_obss_spatial_reuse_set_cmd_tlv - send obss spatial reuse set cmd to fw |
| * @wmi_handle: wmi handle |
| * @obss_spatial_reuse_param: pointer to obss_spatial_reuse_param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static |
| QDF_STATUS send_obss_spatial_reuse_set_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_host_obss_spatial_reuse_set_param |
| *obss_spatial_reuse_param) |
| { |
| wmi_buf_t buf; |
| wmi_obss_spatial_reuse_set_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\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_obss_spatial_reuse_set_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_obss_spatial_reuse_set_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_obss_spatial_reuse_set_cmd_fixed_param)); |
| |
| cmd->enable = obss_spatial_reuse_param->enable; |
| cmd->obss_min = obss_spatial_reuse_param->obss_min; |
| cmd->obss_max = obss_spatial_reuse_param->obss_max; |
| cmd->vdev_id = obss_spatial_reuse_param->vdev_id; |
| |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_OBSS_PD_SPATIAL_REUSE_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(ret)) { |
| WMI_LOGE( |
| "WMI_PDEV_OBSS_PD_SPATIAL_REUSE_CMDID send returned Error %d", |
| ret); |
| wmi_buf_free(buf); |
| } |
| |
| return ret; |
| } |
| #endif |
| |
| #ifdef WLAN_FEATURE_NAN_CONVERGENCE |
| static QDF_STATUS nan_ndp_initiator_req_tlv(wmi_unified_t wmi_handle, |
| struct nan_datapath_initiator_req *ndp_req) |
| { |
| uint16_t len; |
| wmi_buf_t buf; |
| uint8_t *tlv_ptr; |
| QDF_STATUS status; |
| wmi_channel *ch_tlv; |
| wmi_ndp_initiator_req_fixed_param *cmd; |
| uint32_t passphrase_len, service_name_len; |
| uint32_t ndp_cfg_len, ndp_app_info_len, pmk_len; |
| wmi_ndp_transport_ip_param *tcp_ip_param; |
| |
| /* |
| * WMI command expects 4 byte alligned len: |
| * round up ndp_cfg_len and ndp_app_info_len to 4 bytes |
| */ |
| ndp_cfg_len = qdf_roundup(ndp_req->ndp_config.ndp_cfg_len, 4); |
| ndp_app_info_len = qdf_roundup(ndp_req->ndp_info.ndp_app_info_len, 4); |
| pmk_len = qdf_roundup(ndp_req->pmk.pmk_len, 4); |
| passphrase_len = qdf_roundup(ndp_req->passphrase.passphrase_len, 4); |
| service_name_len = |
| qdf_roundup(ndp_req->service_name.service_name_len, 4); |
| /* allocated memory for fixed params as well as variable size data */ |
| len = sizeof(*cmd) + sizeof(*ch_tlv) + (5 * WMI_TLV_HDR_SIZE) |
| + ndp_cfg_len + ndp_app_info_len + pmk_len |
| + passphrase_len + service_name_len; |
| |
| if (ndp_req->is_ipv6_addr_present) |
| len += sizeof(*tcp_ip_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("wmi_buf_alloc failed"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_ndp_initiator_req_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ndp_initiator_req_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ndp_initiator_req_fixed_param)); |
| cmd->vdev_id = wlan_vdev_get_id(ndp_req->vdev); |
| cmd->transaction_id = ndp_req->transaction_id; |
| cmd->service_instance_id = ndp_req->service_instance_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(ndp_req->peer_discovery_mac_addr.bytes, |
| &cmd->peer_discovery_mac_addr); |
| |
| cmd->ndp_cfg_len = ndp_req->ndp_config.ndp_cfg_len; |
| cmd->ndp_app_info_len = ndp_req->ndp_info.ndp_app_info_len; |
| cmd->ndp_channel_cfg = ndp_req->channel_cfg; |
| cmd->nan_pmk_len = ndp_req->pmk.pmk_len; |
| cmd->nan_csid = ndp_req->ncs_sk_type; |
| cmd->nan_passphrase_len = ndp_req->passphrase.passphrase_len; |
| cmd->nan_servicename_len = ndp_req->service_name.service_name_len; |
| |
| ch_tlv = (wmi_channel *)&cmd[1]; |
| WMITLV_SET_HDR(ch_tlv, WMITLV_TAG_STRUC_wmi_channel, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_channel)); |
| ch_tlv->mhz = ndp_req->channel; |
| tlv_ptr = (uint8_t *)&ch_tlv[1]; |
| |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, ndp_cfg_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| ndp_req->ndp_config.ndp_cfg, cmd->ndp_cfg_len); |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + ndp_cfg_len; |
| |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, ndp_app_info_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| ndp_req->ndp_info.ndp_app_info, cmd->ndp_app_info_len); |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + ndp_app_info_len; |
| |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, pmk_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], ndp_req->pmk.pmk, |
| cmd->nan_pmk_len); |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + pmk_len; |
| |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, passphrase_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], ndp_req->passphrase.passphrase, |
| cmd->nan_passphrase_len); |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + passphrase_len; |
| |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, service_name_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| ndp_req->service_name.service_name, |
| cmd->nan_servicename_len); |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + service_name_len; |
| |
| if (ndp_req->is_ipv6_addr_present) { |
| tcp_ip_param = (wmi_ndp_transport_ip_param *)tlv_ptr; |
| WMITLV_SET_HDR(tcp_ip_param, |
| WMITLV_TAG_STRUC_wmi_ndp_transport_ip_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ndp_transport_ip_param)); |
| tcp_ip_param->ipv6_addr_present = true; |
| qdf_mem_copy(tcp_ip_param->ipv6_intf_addr, |
| ndp_req->ipv6_addr, WMI_NDP_IPV6_INTF_ADDR_LEN); |
| } |
| WMI_LOGD(FL("IPv6 addr present: %d, addr: %pI6"), |
| ndp_req->is_ipv6_addr_present, ndp_req->ipv6_addr); |
| |
| WMI_LOGD("vdev_id = %d, transaction_id: %d, service_instance_id: %d, ch: %d, ch_cfg: %d, csid: %d", |
| cmd->vdev_id, cmd->transaction_id, cmd->service_instance_id, |
| ch_tlv->mhz, cmd->ndp_channel_cfg, cmd->nan_csid); |
| WMI_LOGD("peer mac addr: mac_addr31to0: 0x%x, mac_addr47to32: 0x%x", |
| cmd->peer_discovery_mac_addr.mac_addr31to0, |
| cmd->peer_discovery_mac_addr.mac_addr47to32); |
| |
| WMI_LOGD("ndp_config len: %d", cmd->ndp_cfg_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| ndp_req->ndp_config.ndp_cfg, |
| ndp_req->ndp_config.ndp_cfg_len); |
| |
| WMI_LOGD("ndp_app_info len: %d", cmd->ndp_app_info_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| ndp_req->ndp_info.ndp_app_info, |
| ndp_req->ndp_info.ndp_app_info_len); |
| |
| WMI_LOGD("pmk len: %d", cmd->nan_pmk_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| ndp_req->pmk.pmk, cmd->nan_pmk_len); |
| |
| WMI_LOGD("pass phrase len: %d", cmd->nan_passphrase_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| ndp_req->passphrase.passphrase, |
| cmd->nan_passphrase_len); |
| |
| WMI_LOGD("service name len: %d", cmd->nan_servicename_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| ndp_req->service_name.service_name, |
| cmd->nan_servicename_len); |
| |
| WMI_LOGD("sending WMI_NDP_INITIATOR_REQ_CMDID(0x%X)", |
| WMI_NDP_INITIATOR_REQ_CMDID); |
| |
| wmi_mtrace(WMI_NDP_INITIATOR_REQ_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_NDP_INITIATOR_REQ_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_NDP_INITIATOR_REQ_CMDID failed, ret: %d", status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| static QDF_STATUS nan_ndp_responder_req_tlv(wmi_unified_t wmi_handle, |
| struct nan_datapath_responder_req *req) |
| { |
| uint16_t len; |
| wmi_buf_t buf; |
| uint8_t *tlv_ptr; |
| QDF_STATUS status; |
| wmi_ndp_responder_req_fixed_param *cmd; |
| wmi_ndp_transport_ip_param *tcp_ip_param; |
| uint32_t passphrase_len, service_name_len; |
| uint32_t vdev_id = 0, ndp_cfg_len, ndp_app_info_len, pmk_len; |
| |
| vdev_id = wlan_vdev_get_id(req->vdev); |
| WMI_LOGD("vdev_id: %d, transaction_id: %d, ndp_rsp %d, ndp_instance_id: %d, ndp_app_info_len: %d", |
| vdev_id, req->transaction_id, |
| req->ndp_rsp, |
| req->ndp_instance_id, |
| req->ndp_info.ndp_app_info_len); |
| |
| /* |
| * WMI command expects 4 byte alligned len: |
| * round up ndp_cfg_len and ndp_app_info_len to 4 bytes |
| */ |
| ndp_cfg_len = qdf_roundup(req->ndp_config.ndp_cfg_len, 4); |
| ndp_app_info_len = qdf_roundup(req->ndp_info.ndp_app_info_len, 4); |
| pmk_len = qdf_roundup(req->pmk.pmk_len, 4); |
| passphrase_len = qdf_roundup(req->passphrase.passphrase_len, 4); |
| service_name_len = |
| qdf_roundup(req->service_name.service_name_len, 4); |
| |
| /* allocated memory for fixed params as well as variable size data */ |
| len = sizeof(*cmd) + 5*WMI_TLV_HDR_SIZE + ndp_cfg_len + ndp_app_info_len |
| + pmk_len + passphrase_len + service_name_len; |
| |
| if (req->is_ipv6_addr_present || req->is_port_present || |
| req->is_protocol_present) |
| len += sizeof(*tcp_ip_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("wmi_buf_alloc failed"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_ndp_responder_req_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ndp_responder_req_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ndp_responder_req_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->transaction_id = req->transaction_id; |
| cmd->ndp_instance_id = req->ndp_instance_id; |
| cmd->rsp_code = req->ndp_rsp; |
| cmd->ndp_cfg_len = req->ndp_config.ndp_cfg_len; |
| cmd->ndp_app_info_len = req->ndp_info.ndp_app_info_len; |
| cmd->nan_pmk_len = req->pmk.pmk_len; |
| cmd->nan_csid = req->ncs_sk_type; |
| cmd->nan_passphrase_len = req->passphrase.passphrase_len; |
| cmd->nan_servicename_len = req->service_name.service_name_len; |
| |
| tlv_ptr = (uint8_t *)&cmd[1]; |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, ndp_cfg_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| req->ndp_config.ndp_cfg, cmd->ndp_cfg_len); |
| |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + ndp_cfg_len; |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, ndp_app_info_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| req->ndp_info.ndp_app_info, |
| req->ndp_info.ndp_app_info_len); |
| |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + ndp_app_info_len; |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, pmk_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], req->pmk.pmk, |
| cmd->nan_pmk_len); |
| |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + pmk_len; |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, passphrase_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| req->passphrase.passphrase, |
| cmd->nan_passphrase_len); |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + passphrase_len; |
| |
| WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, service_name_len); |
| qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], |
| req->service_name.service_name, |
| cmd->nan_servicename_len); |
| |
| tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + service_name_len; |
| |
| if (req->is_ipv6_addr_present || req->is_port_present || |
| req->is_protocol_present) { |
| tcp_ip_param = (wmi_ndp_transport_ip_param *)tlv_ptr; |
| WMITLV_SET_HDR(tcp_ip_param, |
| WMITLV_TAG_STRUC_wmi_ndp_transport_ip_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_ndp_transport_ip_param)); |
| tcp_ip_param->ipv6_addr_present = req->is_ipv6_addr_present; |
| qdf_mem_copy(tcp_ip_param->ipv6_intf_addr, |
| req->ipv6_addr, WMI_NDP_IPV6_INTF_ADDR_LEN); |
| |
| tcp_ip_param->trans_port_present = req->is_port_present; |
| tcp_ip_param->transport_port = req->port; |
| |
| tcp_ip_param->trans_proto_present = req->is_protocol_present; |
| tcp_ip_param->transport_protocol = req->protocol; |
| } |
| WMI_LOGD(FL("IPv6 addr present: %d, addr: %pI6"), |
| req->is_ipv6_addr_present, req->ipv6_addr); |
| WMI_LOGD(FL("port: %d present: %d"), req->is_port_present, req->port); |
| WMI_LOGD(FL("protocol: %d present: %d"), |
| req->is_protocol_present, req->protocol); |
| |
| WMI_LOGD("vdev_id = %d, transaction_id: %d, csid: %d", |
| cmd->vdev_id, cmd->transaction_id, cmd->nan_csid); |
| |
| WMI_LOGD("ndp_config len: %d", |
| req->ndp_config.ndp_cfg_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| req->ndp_config.ndp_cfg, |
| req->ndp_config.ndp_cfg_len); |
| |
| WMI_LOGD("ndp_app_info len: %d", |
| req->ndp_info.ndp_app_info_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| req->ndp_info.ndp_app_info, |
| req->ndp_info.ndp_app_info_len); |
| |
| WMI_LOGD("pmk len: %d", cmd->nan_pmk_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| req->pmk.pmk, cmd->nan_pmk_len); |
| |
| WMI_LOGD("pass phrase len: %d", cmd->nan_passphrase_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| req->passphrase.passphrase, |
| cmd->nan_passphrase_len); |
| |
| WMI_LOGD("service name len: %d", cmd->nan_servicename_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| req->service_name.service_name, |
| cmd->nan_servicename_len); |
| |
| WMI_LOGD("sending WMI_NDP_RESPONDER_REQ_CMDID(0x%X)", |
| WMI_NDP_RESPONDER_REQ_CMDID); |
| wmi_mtrace(WMI_NDP_RESPONDER_REQ_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_NDP_RESPONDER_REQ_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_NDP_RESPONDER_REQ_CMDID failed, ret: %d", status); |
| wmi_buf_free(buf); |
| } |
| return status; |
| } |
| |
| static QDF_STATUS nan_ndp_end_req_tlv(wmi_unified_t wmi_handle, |
| struct nan_datapath_end_req *req) |
| { |
| uint16_t len; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| uint32_t ndp_end_req_len, i; |
| wmi_ndp_end_req *ndp_end_req_lst; |
| wmi_ndp_end_req_fixed_param *cmd; |
| |
| /* len of tlv following fixed param */ |
| ndp_end_req_len = sizeof(wmi_ndp_end_req) * req->num_ndp_instances; |
| /* above comes out to 4 byte alligned already, no need of padding */ |
| len = sizeof(*cmd) + ndp_end_req_len + WMI_TLV_HDR_SIZE; |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Malloc failed"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_ndp_end_req_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_ndp_end_req_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_ndp_end_req_fixed_param)); |
| |
| cmd->transaction_id = req->transaction_id; |
| |
| /* set tlv pointer to end of fixed param */ |
| WMITLV_SET_HDR((uint8_t *)&cmd[1], WMITLV_TAG_ARRAY_STRUC, |
| ndp_end_req_len); |
| |
| ndp_end_req_lst = (wmi_ndp_end_req *)((uint8_t *)&cmd[1] + |
| WMI_TLV_HDR_SIZE); |
| for (i = 0; i < req->num_ndp_instances; i++) { |
| WMITLV_SET_HDR(&ndp_end_req_lst[i], |
| WMITLV_TAG_ARRAY_FIXED_STRUC, |
| (sizeof(*ndp_end_req_lst) - WMI_TLV_HDR_SIZE)); |
| |
| ndp_end_req_lst[i].ndp_instance_id = req->ndp_ids[i]; |
| } |
| |
| WMI_LOGD("Sending WMI_NDP_END_REQ_CMDID to FW"); |
| wmi_mtrace(WMI_NDP_END_REQ_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_NDP_END_REQ_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_NDP_END_REQ_CMDID failed, ret: %d", status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| static QDF_STATUS extract_ndp_initiator_rsp_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_initiator_rsp *rsp) |
| { |
| WMI_NDP_INITIATOR_RSP_EVENTID_param_tlvs *event; |
| wmi_ndp_initiator_rsp_event_fixed_param *fixed_params; |
| |
| event = (WMI_NDP_INITIATOR_RSP_EVENTID_param_tlvs *)data; |
| fixed_params = event->fixed_param; |
| |
| rsp->vdev = |
| wlan_objmgr_get_vdev_by_id_from_psoc(wmi_handle->soc->wmi_psoc, |
| fixed_params->vdev_id, |
| WLAN_NAN_ID); |
| if (!rsp->vdev) { |
| WMI_LOGE("vdev is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| rsp->transaction_id = fixed_params->transaction_id; |
| rsp->ndp_instance_id = fixed_params->ndp_instance_id; |
| rsp->status = fixed_params->rsp_status; |
| rsp->reason = fixed_params->reason_code; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_ndp_ind_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_indication_event *rsp) |
| { |
| WMI_NDP_INDICATION_EVENTID_param_tlvs *event; |
| wmi_ndp_indication_event_fixed_param *fixed_params; |
| size_t total_array_len; |
| |
| event = (WMI_NDP_INDICATION_EVENTID_param_tlvs *)data; |
| fixed_params = |
| (wmi_ndp_indication_event_fixed_param *)event->fixed_param; |
| |
| if (fixed_params->ndp_cfg_len > event->num_ndp_cfg) { |
| WMI_LOGE("FW message ndp cfg length %d larger than TLV hdr %d", |
| fixed_params->ndp_cfg_len, event->num_ndp_cfg); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (fixed_params->ndp_app_info_len > event->num_ndp_app_info) { |
| WMI_LOGE("FW message ndp app info length %d more than TLV hdr %d", |
| fixed_params->ndp_app_info_len, |
| event->num_ndp_app_info); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (fixed_params->ndp_cfg_len > |
| (WMI_SVC_MSG_MAX_SIZE - sizeof(*fixed_params))) { |
| WMI_LOGE("%s: excess wmi buffer: ndp_cfg_len %d", |
| __func__, fixed_params->ndp_cfg_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| total_array_len = fixed_params->ndp_cfg_len + |
| sizeof(*fixed_params); |
| |
| if (fixed_params->ndp_app_info_len > |
| (WMI_SVC_MSG_MAX_SIZE - total_array_len)) { |
| WMI_LOGE("%s: excess wmi buffer: ndp_cfg_len %d", |
| __func__, fixed_params->ndp_app_info_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| total_array_len += fixed_params->ndp_app_info_len; |
| |
| if (fixed_params->nan_scid_len > |
| (WMI_SVC_MSG_MAX_SIZE - total_array_len)) { |
| WMI_LOGE("%s: excess wmi buffer: ndp_cfg_len %d", |
| __func__, fixed_params->nan_scid_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| rsp->vdev = |
| wlan_objmgr_get_vdev_by_id_from_psoc(wmi_handle->soc->wmi_psoc, |
| fixed_params->vdev_id, |
| WLAN_NAN_ID); |
| if (!rsp->vdev) { |
| WMI_LOGE("vdev is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| rsp->service_instance_id = fixed_params->service_instance_id; |
| rsp->ndp_instance_id = fixed_params->ndp_instance_id; |
| rsp->role = fixed_params->self_ndp_role; |
| rsp->policy = fixed_params->accept_policy; |
| |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_ndi_mac_addr, |
| rsp->peer_mac_addr.bytes); |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_discovery_mac_addr, |
| rsp->peer_discovery_mac_addr.bytes); |
| |
| WMI_LOGD("WMI_NDP_INDICATION_EVENTID(0x%X) received. vdev %d,\n" |
| "service_instance %d, ndp_instance %d, role %d, policy %d,\n" |
| "csid: %d, scid_len: %d, peer_addr: %pM, peer_disc_addr: %pM", |
| WMI_NDP_INDICATION_EVENTID, fixed_params->vdev_id, |
| fixed_params->service_instance_id, |
| fixed_params->ndp_instance_id, fixed_params->self_ndp_role, |
| fixed_params->accept_policy, |
| fixed_params->nan_csid, fixed_params->nan_scid_len, |
| rsp->peer_mac_addr.bytes, |
| rsp->peer_discovery_mac_addr.bytes); |
| |
| WMI_LOGD("ndp_cfg - %d bytes", fixed_params->ndp_cfg_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| &event->ndp_cfg, fixed_params->ndp_cfg_len); |
| |
| WMI_LOGD("ndp_app_info - %d bytes", |
| fixed_params->ndp_app_info_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| &event->ndp_app_info, fixed_params->ndp_app_info_len); |
| |
| rsp->ndp_config.ndp_cfg_len = fixed_params->ndp_cfg_len; |
| rsp->ndp_info.ndp_app_info_len = fixed_params->ndp_app_info_len; |
| rsp->ncs_sk_type = fixed_params->nan_csid; |
| rsp->scid.scid_len = fixed_params->nan_scid_len; |
| |
| if (rsp->ndp_config.ndp_cfg_len > NDP_QOS_INFO_LEN) |
| rsp->ndp_config.ndp_cfg_len = NDP_QOS_INFO_LEN; |
| qdf_mem_copy(rsp->ndp_config.ndp_cfg, event->ndp_cfg, |
| rsp->ndp_config.ndp_cfg_len); |
| |
| if (rsp->ndp_info.ndp_app_info_len > NDP_APP_INFO_LEN) |
| rsp->ndp_info.ndp_app_info_len = NDP_APP_INFO_LEN; |
| qdf_mem_copy(rsp->ndp_info.ndp_app_info, event->ndp_app_info, |
| rsp->ndp_info.ndp_app_info_len); |
| |
| if (rsp->scid.scid_len > NDP_SCID_BUF_LEN) |
| rsp->scid.scid_len = NDP_SCID_BUF_LEN; |
| qdf_mem_copy(rsp->scid.scid, event->ndp_scid, rsp->scid.scid_len); |
| |
| if (event->ndp_transport_ip_param && |
| event->num_ndp_transport_ip_param) { |
| if (event->ndp_transport_ip_param->ipv6_addr_present) { |
| rsp->is_ipv6_addr_present = true; |
| qdf_mem_copy(rsp->ipv6_addr, |
| event->ndp_transport_ip_param->ipv6_intf_addr, |
| WMI_NDP_IPV6_INTF_ADDR_LEN); |
| } |
| } |
| WMI_LOGD(FL("IPv6 addr present: %d, addr: %pI6"), |
| rsp->is_ipv6_addr_present, rsp->ipv6_addr); |
| |
| WMI_LOGD("scid hex dump:"); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| rsp->scid.scid, rsp->scid.scid_len); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_ndp_confirm_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_confirm_event *rsp) |
| { |
| uint8_t i; |
| WMI_HOST_WLAN_PHY_MODE ch_mode; |
| WMI_NDP_CONFIRM_EVENTID_param_tlvs *event; |
| wmi_ndp_confirm_event_fixed_param *fixed_params; |
| size_t total_array_len; |
| |
| event = (WMI_NDP_CONFIRM_EVENTID_param_tlvs *) data; |
| fixed_params = (wmi_ndp_confirm_event_fixed_param *)event->fixed_param; |
| WMI_LOGD("WMI_NDP_CONFIRM_EVENTID(0x%X) received. vdev %d, ndp_instance %d, rsp_code %d, reason_code: %d, num_active_ndps_on_peer: %d", |
| WMI_NDP_CONFIRM_EVENTID, fixed_params->vdev_id, |
| fixed_params->ndp_instance_id, fixed_params->rsp_code, |
| fixed_params->reason_code, |
| fixed_params->num_active_ndps_on_peer); |
| WMI_LOGE("num_ch: %d", fixed_params->num_ndp_channels); |
| |
| if (fixed_params->ndp_cfg_len > event->num_ndp_cfg) { |
| WMI_LOGE("FW message ndp cfg length %d larger than TLV hdr %d", |
| fixed_params->ndp_cfg_len, event->num_ndp_cfg); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGD("ndp_cfg - %d bytes", fixed_params->ndp_cfg_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| &event->ndp_cfg, fixed_params->ndp_cfg_len); |
| |
| if (fixed_params->ndp_app_info_len > event->num_ndp_app_info) { |
| WMI_LOGE("FW message ndp app info length %d more than TLV hdr %d", |
| fixed_params->ndp_app_info_len, |
| event->num_ndp_app_info); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGD("ndp_app_info - %d bytes", |
| fixed_params->ndp_app_info_len); |
| QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| &event->ndp_app_info, fixed_params->ndp_app_info_len); |
| |
| if (fixed_params->ndp_cfg_len > |
| (WMI_SVC_MSG_MAX_SIZE - sizeof(*fixed_params))) { |
| WMI_LOGE("%s: excess wmi buffer: ndp_cfg_len %d", |
| __func__, fixed_params->ndp_cfg_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| total_array_len = fixed_params->ndp_cfg_len + |
| sizeof(*fixed_params); |
| |
| if (fixed_params->ndp_app_info_len > |
| (WMI_SVC_MSG_MAX_SIZE - total_array_len)) { |
| WMI_LOGE("%s: excess wmi buffer: ndp_cfg_len %d", |
| __func__, fixed_params->ndp_app_info_len); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| rsp->vdev = |
| wlan_objmgr_get_vdev_by_id_from_psoc(wmi_handle->soc->wmi_psoc, |
| fixed_params->vdev_id, |
| WLAN_NAN_ID); |
| if (!rsp->vdev) { |
| WMI_LOGE("vdev is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| rsp->ndp_instance_id = fixed_params->ndp_instance_id; |
| rsp->rsp_code = fixed_params->rsp_code; |
| rsp->reason_code = fixed_params->reason_code; |
| rsp->num_active_ndps_on_peer = fixed_params->num_active_ndps_on_peer; |
| rsp->num_channels = fixed_params->num_ndp_channels; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_ndi_mac_addr, |
| rsp->peer_ndi_mac_addr.bytes); |
| rsp->ndp_info.ndp_app_info_len = fixed_params->ndp_app_info_len; |
| qdf_mem_copy(rsp->ndp_info.ndp_app_info, event->ndp_app_info, |
| rsp->ndp_info.ndp_app_info_len); |
| |
| if (rsp->num_channels > NAN_CH_INFO_MAX_CHANNELS) { |
| WMI_LOGE(FL("too many channels")); |
| rsp->num_channels = NAN_CH_INFO_MAX_CHANNELS; |
| } |
| |
| for (i = 0; i < rsp->num_channels; i++) { |
| rsp->ch[i].channel = event->ndp_channel_list[i].mhz; |
| rsp->ch[i].nss = event->nss_list[i]; |
| ch_mode = WMI_GET_CHANNEL_MODE(&event->ndp_channel_list[i]); |
| rsp->ch[i].ch_width = wmi_get_ch_width_from_phy_mode(wmi_handle, |
| ch_mode); |
| WMI_LOGD(FL("ch: %d, ch_mode: %d, nss: %d"), |
| rsp->ch[i].channel, |
| rsp->ch[i].ch_width, |
| rsp->ch[i].nss); |
| } |
| |
| if (event->ndp_transport_ip_param && |
| event->num_ndp_transport_ip_param) { |
| if (event->ndp_transport_ip_param->ipv6_addr_present) { |
| rsp->is_ipv6_addr_present = true; |
| qdf_mem_copy(rsp->ipv6_addr, |
| event->ndp_transport_ip_param->ipv6_intf_addr, |
| WMI_NDP_IPV6_INTF_ADDR_LEN); |
| } |
| |
| if (event->ndp_transport_ip_param->trans_port_present) { |
| rsp->is_port_present = true; |
| rsp->port = |
| event->ndp_transport_ip_param->transport_port; |
| } |
| |
| if (event->ndp_transport_ip_param->trans_proto_present) { |
| rsp->is_protocol_present = true; |
| rsp->protocol = |
| event->ndp_transport_ip_param->transport_protocol; |
| } |
| } |
| WMI_LOGD(FL("IPv6 addr present: %d, addr: %pI6"), |
| rsp->is_ipv6_addr_present, rsp->ipv6_addr); |
| WMI_LOGD(FL("port: %d present: %d"), rsp->port, rsp->is_port_present); |
| WMI_LOGD(FL("protocol: %d present: %d"), |
| rsp->protocol, rsp->is_protocol_present); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_ndp_responder_rsp_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_responder_rsp *rsp) |
| { |
| WMI_NDP_RESPONDER_RSP_EVENTID_param_tlvs *event; |
| wmi_ndp_responder_rsp_event_fixed_param *fixed_params; |
| |
| event = (WMI_NDP_RESPONDER_RSP_EVENTID_param_tlvs *)data; |
| fixed_params = event->fixed_param; |
| |
| WMI_LOGD("WMI_NDP_RESPONDER_RSP_EVENTID(0x%X) received. vdev_id: %d, peer_mac_addr: %pM,transaction_id: %d, status_code %d, reason_code: %d, create_peer: %d", |
| WMI_NDP_RESPONDER_RSP_EVENTID, fixed_params->vdev_id, |
| rsp->peer_mac_addr.bytes, rsp->transaction_id, |
| rsp->status, rsp->reason, rsp->create_peer); |
| |
| rsp->vdev = |
| wlan_objmgr_get_vdev_by_id_from_psoc(wmi_handle->soc->wmi_psoc, |
| fixed_params->vdev_id, |
| WLAN_NAN_ID); |
| if (!rsp->vdev) { |
| WMI_LOGE("vdev is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| rsp->transaction_id = fixed_params->transaction_id; |
| rsp->reason = fixed_params->reason_code; |
| rsp->status = fixed_params->rsp_status; |
| rsp->create_peer = fixed_params->create_peer; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_ndi_mac_addr, |
| rsp->peer_mac_addr.bytes); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_ndp_end_rsp_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_end_rsp_event *rsp) |
| { |
| WMI_NDP_END_RSP_EVENTID_param_tlvs *event; |
| wmi_ndp_end_rsp_event_fixed_param *fixed_params = NULL; |
| |
| event = (WMI_NDP_END_RSP_EVENTID_param_tlvs *) data; |
| fixed_params = (wmi_ndp_end_rsp_event_fixed_param *)event->fixed_param; |
| WMI_LOGD("WMI_NDP_END_RSP_EVENTID(0x%X) received. transaction_id: %d, rsp_status: %d, reason_code: %d", |
| WMI_NDP_END_RSP_EVENTID, fixed_params->transaction_id, |
| fixed_params->rsp_status, fixed_params->reason_code); |
| |
| rsp->vdev = wlan_objmgr_get_vdev_by_opmode_from_psoc( |
| wmi_handle->soc->wmi_psoc, QDF_NDI_MODE, WLAN_NAN_ID); |
| if (!rsp->vdev) { |
| WMI_LOGE("vdev is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| rsp->transaction_id = fixed_params->transaction_id; |
| rsp->reason = fixed_params->reason_code; |
| rsp->status = fixed_params->rsp_status; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_ndp_end_ind_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_end_indication_event **rsp) |
| { |
| uint32_t i, buf_size; |
| wmi_ndp_end_indication *ind; |
| struct qdf_mac_addr peer_addr; |
| WMI_NDP_END_INDICATION_EVENTID_param_tlvs *event; |
| |
| event = (WMI_NDP_END_INDICATION_EVENTID_param_tlvs *) data; |
| ind = event->ndp_end_indication_list; |
| |
| if (event->num_ndp_end_indication_list == 0) { |
| WMI_LOGE("Error: Event ignored, 0 ndp instances"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGD("number of ndp instances = %d", |
| event->num_ndp_end_indication_list); |
| |
| if (event->num_ndp_end_indication_list > ((UINT_MAX - sizeof(**rsp))/ |
| sizeof((*rsp)->ndp_map[0]))) { |
| WMI_LOGE("num_ndp_end_ind_list %d too large", |
| event->num_ndp_end_indication_list); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| buf_size = sizeof(**rsp) + event->num_ndp_end_indication_list * |
| sizeof((*rsp)->ndp_map[0]); |
| *rsp = qdf_mem_malloc(buf_size); |
| if (!(*rsp)) { |
| WMI_LOGE("Failed to allocate memory"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| (*rsp)->vdev = wlan_objmgr_get_vdev_by_opmode_from_psoc( |
| wmi_handle->soc->wmi_psoc, QDF_NDI_MODE, WLAN_NAN_ID); |
| if (!(*rsp)->vdev) { |
| WMI_LOGE("vdev is null"); |
| qdf_mem_free(*rsp); |
| *rsp = NULL; |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| (*rsp)->num_ndp_ids = event->num_ndp_end_indication_list; |
| for (i = 0; i < (*rsp)->num_ndp_ids; i++) { |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&ind[i].peer_ndi_mac_addr, |
| peer_addr.bytes); |
| WMI_LOGD("ind[%d]: type %d, reason_code %d, instance_id %d num_active %d ", |
| i, ind[i].type, ind[i].reason_code, |
| ind[i].ndp_instance_id, |
| ind[i].num_active_ndps_on_peer); |
| /* Add each instance entry to the list */ |
| (*rsp)->ndp_map[i].ndp_instance_id = ind[i].ndp_instance_id; |
| (*rsp)->ndp_map[i].vdev_id = ind[i].vdev_id; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&ind[i].peer_ndi_mac_addr, |
| (*rsp)->ndp_map[i].peer_ndi_mac_addr.bytes); |
| (*rsp)->ndp_map[i].num_active_ndp_sessions = |
| ind[i].num_active_ndps_on_peer; |
| (*rsp)->ndp_map[i].type = ind[i].type; |
| (*rsp)->ndp_map[i].reason_code = ind[i].reason_code; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_ndp_sch_update_tlv(wmi_unified_t wmi_handle, |
| uint8_t *data, struct nan_datapath_sch_update_event *ind) |
| { |
| uint8_t i; |
| WMI_HOST_WLAN_PHY_MODE ch_mode; |
| WMI_NDL_SCHEDULE_UPDATE_EVENTID_param_tlvs *event; |
| wmi_ndl_schedule_update_fixed_param *fixed_params; |
| |
| event = (WMI_NDL_SCHEDULE_UPDATE_EVENTID_param_tlvs *)data; |
| fixed_params = event->fixed_param; |
| |
| WMI_LOGD(FL("flags: %d, num_ch: %d, num_ndp_instances: %d"), |
| fixed_params->flags, fixed_params->num_channels, |
| fixed_params->num_ndp_instances); |
| |
| ind->vdev = |
| wlan_objmgr_get_vdev_by_id_from_psoc(wmi_handle->soc->wmi_psoc, |
| fixed_params->vdev_id, |
| WLAN_NAN_ID); |
| if (!ind->vdev) { |
| WMI_LOGE("vdev is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| ind->flags = fixed_params->flags; |
| ind->num_channels = fixed_params->num_channels; |
| ind->num_ndp_instances = fixed_params->num_ndp_instances; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_macaddr, |
| ind->peer_addr.bytes); |
| |
| if (ind->num_ndp_instances > NDP_NUM_INSTANCE_ID) { |
| WMI_LOGE(FL("uint32 overflow")); |
| wlan_objmgr_vdev_release_ref(ind->vdev, WLAN_NAN_ID); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| qdf_mem_copy(ind->ndp_instances, event->ndp_instance_list, |
| sizeof(uint32_t) * ind->num_ndp_instances); |
| |
| if (ind->num_channels > NAN_CH_INFO_MAX_CHANNELS) { |
| WMI_LOGE(FL("too many channels")); |
| ind->num_channels = NAN_CH_INFO_MAX_CHANNELS; |
| } |
| for (i = 0; i < ind->num_channels; i++) { |
| ind->ch[i].channel = event->ndl_channel_list[i].mhz; |
| ind->ch[i].nss = event->nss_list[i]; |
| ch_mode = WMI_GET_CHANNEL_MODE(&event->ndl_channel_list[i]); |
| ind->ch[i].ch_width = wmi_get_ch_width_from_phy_mode(wmi_handle, |
| ch_mode); |
| WMI_LOGD(FL("ch: %d, ch_mode: %d, nss: %d"), |
| ind->ch[i].channel, |
| ind->ch[i].ch_width, |
| ind->ch[i].nss); |
| } |
| |
| for (i = 0; i < fixed_params->num_ndp_instances; i++) |
| WMI_LOGD(FL("instance_id[%d]: %d"), |
| i, event->ndp_instance_list[i]); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #endif |
| |
| #ifdef QCA_SUPPORT_CP_STATS |
| /** |
| * extract_cca_stats_tlv - api to extract congestion stats from event buffer |
| * @wmi_handle: wma handle |
| * @evt_buf: event buffer |
| * @out_buff: buffer to populated after stats extraction |
| * |
| * Return: status of operation |
| */ |
| static QDF_STATUS extract_cca_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct wmi_host_congestion_stats *out_buff) |
| { |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_congestion_stats *congestion_stats; |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *)evt_buf; |
| congestion_stats = param_buf->congestion_stats; |
| if (!congestion_stats) { |
| WMI_LOGD("%s: no cca stats in event buffer", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| out_buff->vdev_id = congestion_stats->vdev_id; |
| out_buff->congestion = congestion_stats->congestion; |
| |
| WMI_LOGD("%s: cca stats event processed", __func__); |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif /* QCA_SUPPORT_CP_STATS */ |
| |
| /** |
| * save_service_bitmap_tlv() - save service bitmap |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param bitmap_buf: bitmap buffer, for converged legacy support |
| * |
| * Return: QDF_STATUS |
| */ |
| static |
| QDF_STATUS save_service_bitmap_tlv(wmi_unified_t wmi_handle, void *evt_buf, |
| void *bitmap_buf) |
| { |
| WMI_SERVICE_READY_EVENTID_param_tlvs *param_buf; |
| struct wmi_soc *soc = wmi_handle->soc; |
| |
| param_buf = (WMI_SERVICE_READY_EVENTID_param_tlvs *) evt_buf; |
| |
| /* If it is already allocated, use that buffer. This can happen |
| * during target stop/start scenarios where host allocation is skipped. |
| */ |
| if (!soc->wmi_service_bitmap) { |
| soc->wmi_service_bitmap = |
| qdf_mem_malloc(WMI_SERVICE_BM_SIZE * sizeof(uint32_t)); |
| if (!soc->wmi_service_bitmap) { |
| WMI_LOGE("Failed memory allocation for service bitmap"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| } |
| |
| qdf_mem_copy(soc->wmi_service_bitmap, |
| param_buf->wmi_service_bitmap, |
| (WMI_SERVICE_BM_SIZE * sizeof(uint32_t))); |
| |
| if (bitmap_buf) |
| qdf_mem_copy(bitmap_buf, |
| param_buf->wmi_service_bitmap, |
| (WMI_SERVICE_BM_SIZE * sizeof(uint32_t))); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * save_ext_service_bitmap_tlv() - save extendend service bitmap |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param bitmap_buf: bitmap buffer, for converged legacy support |
| * |
| * Return: QDF_STATUS |
| */ |
| static |
| QDF_STATUS save_ext_service_bitmap_tlv(wmi_unified_t wmi_handle, void *evt_buf, |
| void *bitmap_buf) |
| { |
| WMI_SERVICE_AVAILABLE_EVENTID_param_tlvs *param_buf; |
| wmi_service_available_event_fixed_param *ev; |
| struct wmi_soc *soc = wmi_handle->soc; |
| |
| param_buf = (WMI_SERVICE_AVAILABLE_EVENTID_param_tlvs *) evt_buf; |
| |
| ev = param_buf->fixed_param; |
| |
| /* If it is already allocated, use that buffer. This can happen |
| * during target stop/start scenarios where host allocation is skipped. |
| */ |
| if (!soc->wmi_ext_service_bitmap) { |
| soc->wmi_ext_service_bitmap = qdf_mem_malloc( |
| WMI_SERVICE_SEGMENT_BM_SIZE32 * sizeof(uint32_t)); |
| if (!soc->wmi_ext_service_bitmap) { |
| WMI_LOGE("Failed memory allocation for service bitmap"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| } |
| |
| qdf_mem_copy(soc->wmi_ext_service_bitmap, |
| ev->wmi_service_segment_bitmap, |
| (WMI_SERVICE_SEGMENT_BM_SIZE32 * sizeof(uint32_t))); |
| |
| WMI_LOGD("wmi_ext_service_bitmap 0:0x%x, 1:0x%x, 2:0x%x, 3:0x%x\n", |
| soc->wmi_ext_service_bitmap[0], soc->wmi_ext_service_bitmap[1], |
| soc->wmi_ext_service_bitmap[2], soc->wmi_ext_service_bitmap[3]); |
| |
| if (bitmap_buf) |
| qdf_mem_copy(bitmap_buf, |
| soc->wmi_ext_service_bitmap, |
| (WMI_SERVICE_SEGMENT_BM_SIZE32 * sizeof(uint32_t))); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| /** |
| * is_service_enabled_tlv() - Check if service enabled |
| * @param wmi_handle: wmi handle |
| * @param service_id: service identifier |
| * |
| * Return: 1 enabled, 0 disabled |
| */ |
| static bool is_service_enabled_tlv(wmi_unified_t wmi_handle, |
| uint32_t service_id) |
| { |
| struct wmi_soc *soc = wmi_handle->soc; |
| |
| if (!soc->wmi_service_bitmap) { |
| WMI_LOGE("WMI service bit map is not saved yet\n"); |
| return false; |
| } |
| |
| /* if wmi_service_enabled was received with extended bitmap, |
| * use WMI_SERVICE_EXT_IS_ENABLED to check the services. |
| */ |
| if (soc->wmi_ext_service_bitmap) |
| return WMI_SERVICE_EXT_IS_ENABLED(soc->wmi_service_bitmap, |
| soc->wmi_ext_service_bitmap, |
| service_id); |
| |
| if (service_id >= WMI_MAX_SERVICE) { |
| WMI_LOGE("Service id %d but WMI ext service bitmap is NULL", |
| service_id); |
| return false; |
| } |
| |
| return WMI_SERVICE_IS_ENABLED(soc->wmi_service_bitmap, |
| service_id); |
| } |
| |
| static inline void copy_ht_cap_info(uint32_t ev_target_cap, |
| struct wlan_psoc_target_capability_info *cap) |
| { |
| /* except LDPC all flags are common betwen legacy and here |
| * also IBFEER is not defined for TLV |
| */ |
| cap->ht_cap_info |= ev_target_cap & ( |
| WMI_HT_CAP_ENABLED |
| | WMI_HT_CAP_HT20_SGI |
| | WMI_HT_CAP_DYNAMIC_SMPS |
| | WMI_HT_CAP_TX_STBC |
| | WMI_HT_CAP_TX_STBC_MASK_SHIFT |
| | WMI_HT_CAP_RX_STBC |
| | WMI_HT_CAP_RX_STBC_MASK_SHIFT |
| | WMI_HT_CAP_LDPC |
| | WMI_HT_CAP_L_SIG_TXOP_PROT |
| | WMI_HT_CAP_MPDU_DENSITY |
| | WMI_HT_CAP_MPDU_DENSITY_MASK_SHIFT |
| | WMI_HT_CAP_HT40_SGI); |
| if (ev_target_cap & WMI_HT_CAP_LDPC) |
| cap->ht_cap_info |= WMI_HOST_HT_CAP_RX_LDPC | |
| WMI_HOST_HT_CAP_TX_LDPC; |
| } |
| /** |
| * extract_service_ready_tlv() - extract service ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to received event buffer |
| * @param cap: pointer to hold target capability information extracted from even |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_service_ready_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct wlan_psoc_target_capability_info *cap) |
| { |
| WMI_SERVICE_READY_EVENTID_param_tlvs *param_buf; |
| wmi_service_ready_event_fixed_param *ev; |
| |
| |
| param_buf = (WMI_SERVICE_READY_EVENTID_param_tlvs *) evt_buf; |
| |
| ev = (wmi_service_ready_event_fixed_param *) param_buf->fixed_param; |
| if (!ev) { |
| qdf_print("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cap->phy_capability = ev->phy_capability; |
| cap->max_frag_entry = ev->max_frag_entry; |
| cap->num_rf_chains = ev->num_rf_chains; |
| copy_ht_cap_info(ev->ht_cap_info, cap); |
| cap->vht_cap_info = ev->vht_cap_info; |
| cap->vht_supp_mcs = ev->vht_supp_mcs; |
| cap->hw_min_tx_power = ev->hw_min_tx_power; |
| cap->hw_max_tx_power = ev->hw_max_tx_power; |
| cap->sys_cap_info = ev->sys_cap_info; |
| cap->min_pkt_size_enable = ev->min_pkt_size_enable; |
| cap->max_bcn_ie_size = ev->max_bcn_ie_size; |
| cap->max_num_scan_channels = ev->max_num_scan_channels; |
| cap->max_supported_macs = ev->max_supported_macs; |
| cap->wmi_fw_sub_feat_caps = ev->wmi_fw_sub_feat_caps; |
| cap->txrx_chainmask = ev->txrx_chainmask; |
| cap->default_dbs_hw_mode_index = ev->default_dbs_hw_mode_index; |
| cap->num_msdu_desc = ev->num_msdu_desc; |
| cap->fw_version = ev->fw_build_vers; |
| /* fw_version_1 is not available in TLV. */ |
| cap->fw_version_1 = 0; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /* convert_wireless_modes_tlv() - Convert REGDMN_MODE values sent by target |
| * to host internal WMI_HOST_REGDMN_MODE values. |
| * REGULATORY TODO : REGDMN_MODE_11AC_VHT*_2G values are not used by the |
| * host currently. Add this in the future if required. |
| * 11AX (Phase II) : 11ax related values are not currently |
| * advertised separately by FW. As part of phase II regulatory bring-up, |
| * finalize the advertisement mechanism. |
| * @target_wireless_mode: target wireless mode received in message |
| * |
| * Return: returns the host internal wireless mode. |
| */ |
| static inline uint32_t convert_wireless_modes_tlv(uint32_t target_wireless_mode) |
| { |
| |
| uint32_t wireless_modes = 0; |
| |
| if (target_wireless_mode & REGDMN_MODE_11A) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11A; |
| |
| if (target_wireless_mode & REGDMN_MODE_TURBO) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_TURBO; |
| |
| if (target_wireless_mode & REGDMN_MODE_11B) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11B; |
| |
| if (target_wireless_mode & REGDMN_MODE_PUREG) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_PUREG; |
| |
| if (target_wireless_mode & REGDMN_MODE_11G) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11G; |
| |
| if (target_wireless_mode & REGDMN_MODE_108G) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_108G; |
| |
| if (target_wireless_mode & REGDMN_MODE_108A) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_108A; |
| |
| if (target_wireless_mode & REGDMN_MODE_XR) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_XR; |
| |
| if (target_wireless_mode & REGDMN_MODE_11A_HALF_RATE) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11A_HALF_RATE; |
| |
| if (target_wireless_mode & REGDMN_MODE_11A_QUARTER_RATE) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11A_QUARTER_RATE; |
| |
| if (target_wireless_mode & REGDMN_MODE_11NG_HT20) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11NG_HT20; |
| |
| if (target_wireless_mode & REGDMN_MODE_11NA_HT20) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11NA_HT20; |
| |
| if (target_wireless_mode & REGDMN_MODE_11NG_HT40PLUS) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11NG_HT40PLUS; |
| |
| if (target_wireless_mode & REGDMN_MODE_11NG_HT40MINUS) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11NG_HT40MINUS; |
| |
| if (target_wireless_mode & REGDMN_MODE_11NA_HT40PLUS) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11NA_HT40PLUS; |
| |
| if (target_wireless_mode & REGDMN_MODE_11NA_HT40MINUS) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11NA_HT40MINUS; |
| |
| if (target_wireless_mode & REGDMN_MODE_11AC_VHT20) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT20; |
| |
| if (target_wireless_mode & REGDMN_MODE_11AC_VHT40PLUS) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT40PLUS; |
| |
| if (target_wireless_mode & REGDMN_MODE_11AC_VHT40MINUS) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT40MINUS; |
| |
| if (target_wireless_mode & REGDMN_MODE_11AC_VHT80) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT80; |
| |
| if (target_wireless_mode & REGDMN_MODE_11AC_VHT160) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT160; |
| |
| if (target_wireless_mode & REGDMN_MODE_11AC_VHT80_80) |
| wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT80_80; |
| |
| return wireless_modes; |
| } |
| |
| /** |
| * extract_hal_reg_cap_tlv() - extract HAL registered capabilities |
| * @wmi_handle: wmi handle |
| * @param evt_buf: Pointer to event buffer |
| * @param cap: pointer to hold HAL reg capabilities |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_hal_reg_cap_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct wlan_psoc_hal_reg_capability *cap) |
| { |
| WMI_SERVICE_READY_EVENTID_param_tlvs *param_buf; |
| |
| param_buf = (WMI_SERVICE_READY_EVENTID_param_tlvs *) evt_buf; |
| |
| qdf_mem_copy(cap, (((uint8_t *)param_buf->hal_reg_capabilities) + |
| sizeof(uint32_t)), |
| sizeof(struct wlan_psoc_hal_reg_capability)); |
| |
| cap->wireless_modes = convert_wireless_modes_tlv( |
| param_buf->hal_reg_capabilities->wireless_modes); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_host_mem_req_tlv() - Extract host memory request event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param num_entries: pointer to hold number of entries requested |
| * |
| * Return: Number of entries requested |
| */ |
| static host_mem_req *extract_host_mem_req_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint8_t *num_entries) |
| { |
| WMI_SERVICE_READY_EVENTID_param_tlvs *param_buf; |
| wmi_service_ready_event_fixed_param *ev; |
| |
| param_buf = (WMI_SERVICE_READY_EVENTID_param_tlvs *) evt_buf; |
| |
| ev = (wmi_service_ready_event_fixed_param *) param_buf->fixed_param; |
| if (!ev) { |
| qdf_print("%s: wmi_buf_alloc failed", __func__); |
| return NULL; |
| } |
| |
| *num_entries = ev->num_mem_reqs; |
| |
| return (host_mem_req *)param_buf->mem_reqs; |
| } |
| |
| /** |
| * save_fw_version_in_service_ready_tlv() - Save fw version in service |
| * ready function |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS |
| save_fw_version_in_service_ready_tlv(wmi_unified_t wmi_handle, void *evt_buf) |
| { |
| WMI_SERVICE_READY_EVENTID_param_tlvs *param_buf; |
| wmi_service_ready_event_fixed_param *ev; |
| |
| |
| param_buf = (WMI_SERVICE_READY_EVENTID_param_tlvs *) evt_buf; |
| |
| ev = (wmi_service_ready_event_fixed_param *) param_buf->fixed_param; |
| if (!ev) { |
| qdf_print("%s: wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| /*Save fw version from service ready message */ |
| /*This will be used while sending INIT message */ |
| qdf_mem_copy(&wmi_handle->fw_abi_version, &ev->fw_abi_vers, |
| sizeof(wmi_handle->fw_abi_version)); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * ready_extract_init_status_tlv() - Extract init status from ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: Pointer to event buffer |
| * |
| * Return: ready status |
| */ |
| static uint32_t ready_extract_init_status_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf) |
| { |
| WMI_READY_EVENTID_param_tlvs *param_buf = NULL; |
| wmi_ready_event_fixed_param *ev = NULL; |
| |
| param_buf = (WMI_READY_EVENTID_param_tlvs *) evt_buf; |
| ev = param_buf->fixed_param; |
| |
| qdf_print("%s:%d", __func__, ev->status); |
| |
| return ev->status; |
| } |
| |
| /** |
| * ready_extract_mac_addr_tlv() - extract mac address from ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param macaddr: Pointer to hold MAC address |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS ready_extract_mac_addr_tlv(wmi_unified_t wmi_hamdle, |
| void *evt_buf, uint8_t *macaddr) |
| { |
| WMI_READY_EVENTID_param_tlvs *param_buf = NULL; |
| wmi_ready_event_fixed_param *ev = NULL; |
| |
| |
| param_buf = (WMI_READY_EVENTID_param_tlvs *) evt_buf; |
| ev = param_buf->fixed_param; |
| |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->mac_addr, macaddr); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * ready_extract_mac_addr_list_tlv() - extract MAC address list from ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param macaddr: Pointer to hold number of MAC addresses |
| * |
| * Return: Pointer to addr list |
| */ |
| static wmi_host_mac_addr *ready_extract_mac_addr_list_tlv(wmi_unified_t wmi_hamdle, |
| void *evt_buf, uint8_t *num_mac) |
| { |
| WMI_READY_EVENTID_param_tlvs *param_buf = NULL; |
| wmi_ready_event_fixed_param *ev = NULL; |
| |
| param_buf = (WMI_READY_EVENTID_param_tlvs *) evt_buf; |
| ev = param_buf->fixed_param; |
| |
| *num_mac = ev->num_extra_mac_addr; |
| |
| return (wmi_host_mac_addr *) param_buf->mac_addr_list; |
| } |
| |
| /** |
| * extract_ready_params_tlv() - Extract data from ready event apart from |
| * status, macaddr and version. |
| * @wmi_handle: Pointer to WMI handle. |
| * @evt_buf: Pointer to Ready event buffer. |
| * @ev_param: Pointer to host defined struct to copy the data from event. |
| * |
| * Return: QDF_STATUS_SUCCESS on success. |
| */ |
| static QDF_STATUS extract_ready_event_params_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct wmi_host_ready_ev_param *ev_param) |
| { |
| WMI_READY_EVENTID_param_tlvs *param_buf = NULL; |
| wmi_ready_event_fixed_param *ev = NULL; |
| |
| param_buf = (WMI_READY_EVENTID_param_tlvs *) evt_buf; |
| ev = param_buf->fixed_param; |
| |
| ev_param->status = ev->status; |
| ev_param->num_dscp_table = ev->num_dscp_table; |
| ev_param->num_extra_mac_addr = ev->num_extra_mac_addr; |
| ev_param->num_total_peer = ev->num_total_peers; |
| ev_param->num_extra_peer = ev->num_extra_peers; |
| /* Agile_cap in ready event is not supported in TLV target */ |
| ev_param->agile_capability = false; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_dbglog_data_len_tlv() - extract debuglog data length |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * |
| * Return: length |
| */ |
| static uint8_t *extract_dbglog_data_len_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t *len) |
| { |
| WMI_DEBUG_MESG_EVENTID_param_tlvs *param_buf; |
| |
| param_buf = (WMI_DEBUG_MESG_EVENTID_param_tlvs *) evt_buf; |
| |
| *len = param_buf->num_bufp; |
| |
| return param_buf->bufp; |
| } |
| |
| /** |
| * extract_vdev_start_resp_tlv() - extract vdev start response |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param vdev_rsp: Pointer to hold vdev response |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_start_resp_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, wmi_host_vdev_start_resp *vdev_rsp) |
| { |
| WMI_VDEV_START_RESP_EVENTID_param_tlvs *param_buf; |
| wmi_vdev_start_response_event_fixed_param *ev; |
| |
| param_buf = (WMI_VDEV_START_RESP_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) { |
| qdf_print("Invalid start response event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| ev = param_buf->fixed_param; |
| if (!ev) { |
| qdf_print("Invalid start response event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| qdf_mem_zero(vdev_rsp, sizeof(*vdev_rsp)); |
| |
| vdev_rsp->vdev_id = ev->vdev_id; |
| vdev_rsp->requestor_id = ev->requestor_id; |
| switch (ev->resp_type) { |
| case WMI_VDEV_START_RESP_EVENT: |
| vdev_rsp->resp_type = WMI_HOST_VDEV_START_RESP_EVENT; |
| break; |
| case WMI_VDEV_RESTART_RESP_EVENT: |
| vdev_rsp->resp_type = WMI_HOST_VDEV_RESTART_RESP_EVENT; |
| break; |
| default: |
| qdf_print("Invalid start response event buffer"); |
| break; |
| }; |
| vdev_rsp->status = ev->status; |
| vdev_rsp->chain_mask = ev->chain_mask; |
| vdev_rsp->smps_mode = ev->smps_mode; |
| vdev_rsp->mac_id = ev->mac_id; |
| vdev_rsp->cfgd_tx_streams = ev->cfgd_tx_streams; |
| vdev_rsp->cfgd_rx_streams = ev->cfgd_rx_streams; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_vdev_delete_resp_tlv() - extract vdev delete response |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param delete_rsp: Pointer to hold vdev delete response |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_delete_resp_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct wmi_host_vdev_delete_resp *delete_rsp) |
| { |
| WMI_VDEV_DELETE_RESP_EVENTID_param_tlvs *param_buf; |
| wmi_vdev_delete_resp_event_fixed_param *ev; |
| |
| param_buf = (WMI_VDEV_DELETE_RESP_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("Invalid vdev delete response event buffer\n"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| ev = param_buf->fixed_param; |
| if (!ev) { |
| WMI_LOGE("Invalid vdev delete response event\n"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| qdf_mem_zero(delete_rsp, sizeof(*delete_rsp)); |
| delete_rsp->vdev_id = ev->vdev_id; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| |
| /** |
| * extract_tbttoffset_num_vdevs_tlv() - extract tbtt offset num vdev |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param num_vdevs: Pointer to hold num vdev |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_tbttoffset_num_vdevs_tlv(void *wmi_hdl, |
| void *evt_buf, uint32_t *num_vdevs) |
| { |
| WMI_TBTTOFFSET_UPDATE_EVENTID_param_tlvs *param_buf; |
| wmi_tbtt_offset_event_fixed_param *tbtt_offset_event; |
| uint32_t vdev_map; |
| |
| param_buf = (WMI_TBTTOFFSET_UPDATE_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| qdf_print("Invalid tbtt update ext event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| tbtt_offset_event = param_buf->fixed_param; |
| vdev_map = tbtt_offset_event->vdev_map; |
| *num_vdevs = wmi_vdev_map_to_num_vdevs(vdev_map); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_ext_tbttoffset_num_vdevs_tlv() - extract ext tbtt offset num vdev |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param num_vdevs: Pointer to hold num vdev |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_ext_tbttoffset_num_vdevs_tlv(void *wmi_hdl, |
| void *evt_buf, uint32_t *num_vdevs) |
| { |
| WMI_TBTTOFFSET_EXT_UPDATE_EVENTID_param_tlvs *param_buf; |
| wmi_tbtt_offset_ext_event_fixed_param *tbtt_offset_ext_event; |
| |
| param_buf = (WMI_TBTTOFFSET_EXT_UPDATE_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| qdf_print("Invalid tbtt update ext event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| tbtt_offset_ext_event = param_buf->fixed_param; |
| |
| *num_vdevs = tbtt_offset_ext_event->num_vdevs; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_tbttoffset_update_params_tlv() - extract tbtt offset param |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param idx: Index referring to a vdev |
| * @param tbtt_param: Pointer to tbttoffset event param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_tbttoffset_update_params_tlv(void *wmi_hdl, |
| void *evt_buf, uint8_t idx, |
| struct tbttoffset_params *tbtt_param) |
| { |
| WMI_TBTTOFFSET_UPDATE_EVENTID_param_tlvs *param_buf; |
| wmi_tbtt_offset_event_fixed_param *tbtt_offset_event; |
| uint32_t vdev_map; |
| |
| param_buf = (WMI_TBTTOFFSET_UPDATE_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) { |
| qdf_print("Invalid tbtt update event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| tbtt_offset_event = param_buf->fixed_param; |
| vdev_map = tbtt_offset_event->vdev_map; |
| tbtt_param->vdev_id = wmi_vdev_map_to_vdev_id(vdev_map, idx); |
| if (tbtt_param->vdev_id == WLAN_INVALID_VDEV_ID) |
| return QDF_STATUS_E_INVAL; |
| tbtt_param->tbttoffset = |
| param_buf->tbttoffset_list[tbtt_param->vdev_id]; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_ext_tbttoffset_update_params_tlv() - extract ext tbtt offset param |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param idx: Index referring to a vdev |
| * @param tbtt_param: Pointer to tbttoffset event param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_ext_tbttoffset_update_params_tlv(void *wmi_hdl, |
| void *evt_buf, uint8_t idx, |
| struct tbttoffset_params *tbtt_param) |
| { |
| WMI_TBTTOFFSET_EXT_UPDATE_EVENTID_param_tlvs *param_buf; |
| wmi_tbtt_offset_info *tbtt_offset_info; |
| |
| param_buf = (WMI_TBTTOFFSET_EXT_UPDATE_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| qdf_print("Invalid tbtt update event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| tbtt_offset_info = ¶m_buf->tbtt_offset_info[idx]; |
| |
| tbtt_param->vdev_id = tbtt_offset_info->vdev_id; |
| tbtt_param->tbttoffset = tbtt_offset_info->tbttoffset; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef CONFIG_MCL |
| #define IS_WMI_RX_MGMT_FRAME_STATUS_INVALID(_status) \ |
| ((_status) & WMI_RXERR_DECRYPT) |
| #else |
| #define IS_WMI_RX_MGMT_FRAME_STATUS_INVALID(_status) false |
| #endif |
| |
| /** |
| * extract_mgmt_rx_params_tlv() - extract management rx params from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param hdr: Pointer to hold header |
| * @param bufp: Pointer to hold pointer to rx param buffer |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_mgmt_rx_params_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct mgmt_rx_event_params *hdr, |
| uint8_t **bufp) |
| { |
| WMI_MGMT_RX_EVENTID_param_tlvs *param_tlvs = NULL; |
| wmi_mgmt_rx_hdr *ev_hdr = NULL; |
| int i; |
| |
| param_tlvs = (WMI_MGMT_RX_EVENTID_param_tlvs *) evt_buf; |
| if (!param_tlvs) { |
| WMI_LOGE("Get NULL point message from FW"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| ev_hdr = param_tlvs->hdr; |
| if (!hdr) { |
| WMI_LOGE("Rx event is NULL"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (IS_WMI_RX_MGMT_FRAME_STATUS_INVALID(ev_hdr->status)) { |
| WMI_LOGE("%s: RX mgmt frame decrypt error, discard it", |
| __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| hdr->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| ev_hdr->pdev_id); |
| |
| hdr->channel = ev_hdr->channel; |
| hdr->snr = ev_hdr->snr; |
| hdr->rate = ev_hdr->rate; |
| hdr->phy_mode = ev_hdr->phy_mode; |
| hdr->buf_len = ev_hdr->buf_len; |
| hdr->status = ev_hdr->status; |
| hdr->flags = ev_hdr->flags; |
| hdr->rssi = ev_hdr->rssi; |
| hdr->tsf_delta = ev_hdr->tsf_delta; |
| for (i = 0; i < ATH_MAX_ANTENNA; i++) |
| hdr->rssi_ctl[i] = ev_hdr->rssi_ctl[i]; |
| |
| *bufp = param_tlvs->bufp; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_vdev_stopped_param_tlv() - extract vdev stop param from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param vdev_id: Pointer to hold vdev identifier |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_stopped_param_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t *vdev_id) |
| { |
| WMI_VDEV_STOPPED_EVENTID_param_tlvs *param_buf; |
| wmi_vdev_stopped_event_fixed_param *resp_event; |
| |
| param_buf = (WMI_VDEV_STOPPED_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("Invalid event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| resp_event = param_buf->fixed_param; |
| *vdev_id = resp_event->vdev_id; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_vdev_roam_param_tlv() - extract vdev roam param from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold roam param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_roam_param_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, wmi_host_roam_event *param) |
| { |
| WMI_ROAM_EVENTID_param_tlvs *param_buf; |
| wmi_roam_event_fixed_param *evt; |
| |
| param_buf = (WMI_ROAM_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("Invalid roam event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| evt = param_buf->fixed_param; |
| qdf_mem_zero(param, sizeof(*param)); |
| |
| param->vdev_id = evt->vdev_id; |
| param->reason = evt->reason; |
| param->rssi = evt->rssi; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_vdev_scan_ev_param_tlv() - extract vdev scan param from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold vdev scan param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_scan_ev_param_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct scan_event *param) |
| { |
| WMI_SCAN_EVENTID_param_tlvs *param_buf = NULL; |
| wmi_scan_event_fixed_param *evt = NULL; |
| |
| param_buf = (WMI_SCAN_EVENTID_param_tlvs *) evt_buf; |
| evt = param_buf->fixed_param; |
| |
| qdf_mem_zero(param, sizeof(*param)); |
| |
| switch (evt->event) { |
| case WMI_SCAN_EVENT_STARTED: |
| param->type = SCAN_EVENT_TYPE_STARTED; |
| break; |
| case WMI_SCAN_EVENT_COMPLETED: |
| param->type = SCAN_EVENT_TYPE_COMPLETED; |
| break; |
| case WMI_SCAN_EVENT_BSS_CHANNEL: |
| param->type = SCAN_EVENT_TYPE_BSS_CHANNEL; |
| break; |
| case WMI_SCAN_EVENT_FOREIGN_CHANNEL: |
| param->type = SCAN_EVENT_TYPE_FOREIGN_CHANNEL; |
| break; |
| case WMI_SCAN_EVENT_DEQUEUED: |
| param->type = SCAN_EVENT_TYPE_DEQUEUED; |
| break; |
| case WMI_SCAN_EVENT_PREEMPTED: |
| param->type = SCAN_EVENT_TYPE_PREEMPTED; |
| break; |
| case WMI_SCAN_EVENT_START_FAILED: |
| param->type = SCAN_EVENT_TYPE_START_FAILED; |
| break; |
| case WMI_SCAN_EVENT_RESTARTED: |
| param->type = SCAN_EVENT_TYPE_RESTARTED; |
| break; |
| case WMI_SCAN_EVENT_FOREIGN_CHANNEL_EXIT: |
| param->type = SCAN_EVENT_TYPE_FOREIGN_CHANNEL_EXIT; |
| break; |
| case WMI_SCAN_EVENT_MAX: |
| default: |
| param->type = SCAN_EVENT_TYPE_MAX; |
| break; |
| }; |
| |
| switch (evt->reason) { |
| case WMI_SCAN_REASON_NONE: |
| param->reason = SCAN_REASON_NONE; |
| break; |
| case WMI_SCAN_REASON_COMPLETED: |
| param->reason = SCAN_REASON_COMPLETED; |
| break; |
| case WMI_SCAN_REASON_CANCELLED: |
| param->reason = SCAN_REASON_CANCELLED; |
| break; |
| case WMI_SCAN_REASON_PREEMPTED: |
| param->reason = SCAN_REASON_PREEMPTED; |
| break; |
| case WMI_SCAN_REASON_TIMEDOUT: |
| param->reason = SCAN_REASON_TIMEDOUT; |
| break; |
| case WMI_SCAN_REASON_INTERNAL_FAILURE: |
| param->reason = SCAN_REASON_INTERNAL_FAILURE; |
| break; |
| case WMI_SCAN_REASON_SUSPENDED: |
| param->reason = SCAN_REASON_SUSPENDED; |
| break; |
| case WMI_SCAN_REASON_MAX: |
| param->reason = SCAN_REASON_MAX; |
| break; |
| default: |
| param->reason = SCAN_REASON_MAX; |
| break; |
| }; |
| |
| param->chan_freq = evt->channel_freq; |
| param->requester = evt->requestor; |
| param->scan_id = evt->scan_id; |
| param->vdev_id = evt->vdev_id; |
| param->timestamp = evt->tsf_timestamp; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef CONVERGED_TDLS_ENABLE |
| /** |
| * extract_vdev_tdls_ev_param_tlv() - extract vdev tdls param from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold vdev tdls param |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_tdls_ev_param_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct tdls_event_info *param) |
| { |
| WMI_TDLS_PEER_EVENTID_param_tlvs *param_buf; |
| wmi_tdls_peer_event_fixed_param *evt; |
| |
| param_buf = (WMI_TDLS_PEER_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("%s: NULL param_buf", __func__); |
| return QDF_STATUS_E_NULL_VALUE; |
| } |
| |
| evt = param_buf->fixed_param; |
| |
| qdf_mem_zero(param, sizeof(*param)); |
| |
| param->vdev_id = evt->vdev_id; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&evt->peer_macaddr, |
| param->peermac.bytes); |
| switch (evt->peer_status) { |
| case WMI_TDLS_SHOULD_DISCOVER: |
| param->message_type = TDLS_SHOULD_DISCOVER; |
| break; |
| case WMI_TDLS_SHOULD_TEARDOWN: |
| param->message_type = TDLS_SHOULD_TEARDOWN; |
| break; |
| case WMI_TDLS_PEER_DISCONNECTED: |
| param->message_type = TDLS_PEER_DISCONNECTED; |
| break; |
| case WMI_TDLS_CONNECTION_TRACKER_NOTIFICATION: |
| param->message_type = TDLS_CONNECTION_TRACKER_NOTIFY; |
| break; |
| default: |
| WMI_LOGE("%s: Discarding unknown tdls event %d from target", |
| __func__, evt->peer_status); |
| return QDF_STATUS_E_INVAL; |
| }; |
| |
| switch (evt->peer_reason) { |
| case WMI_TDLS_TEARDOWN_REASON_TX: |
| param->peer_reason = TDLS_TEARDOWN_TX; |
| break; |
| case WMI_TDLS_TEARDOWN_REASON_RSSI: |
| param->peer_reason = TDLS_TEARDOWN_RSSI; |
| break; |
| case WMI_TDLS_TEARDOWN_REASON_SCAN: |
| param->peer_reason = TDLS_TEARDOWN_SCAN; |
| break; |
| case WMI_TDLS_DISCONNECTED_REASON_PEER_DELETE: |
| param->peer_reason = TDLS_DISCONNECTED_PEER_DELETE; |
| break; |
| case WMI_TDLS_TEARDOWN_REASON_PTR_TIMEOUT: |
| param->peer_reason = TDLS_TEARDOWN_PTR_TIMEOUT; |
| break; |
| case WMI_TDLS_TEARDOWN_REASON_BAD_PTR: |
| param->peer_reason = TDLS_TEARDOWN_BAD_PTR; |
| break; |
| case WMI_TDLS_TEARDOWN_REASON_NO_RESPONSE: |
| param->peer_reason = TDLS_TEARDOWN_NO_RSP; |
| break; |
| case WMI_TDLS_ENTER_BUF_STA: |
| param->peer_reason = TDLS_PEER_ENTER_BUF_STA; |
| break; |
| case WMI_TDLS_EXIT_BUF_STA: |
| param->peer_reason = TDLS_PEER_EXIT_BUF_STA; |
| break; |
| case WMI_TDLS_ENTER_BT_BUSY_MODE: |
| param->peer_reason = TDLS_ENTER_BT_BUSY; |
| break; |
| case WMI_TDLS_EXIT_BT_BUSY_MODE: |
| param->peer_reason = TDLS_EXIT_BT_BUSY; |
| break; |
| case WMI_TDLS_SCAN_STARTED_EVENT: |
| param->peer_reason = TDLS_SCAN_STARTED; |
| break; |
| case WMI_TDLS_SCAN_COMPLETED_EVENT: |
| param->peer_reason = TDLS_SCAN_COMPLETED; |
| break; |
| |
| default: |
| WMI_LOGE("%s: unknown reason %d in tdls event %d from target", |
| __func__, evt->peer_reason, evt->peer_status); |
| return QDF_STATUS_E_INVAL; |
| }; |
| |
| WMI_LOGD("%s: tdls event, peer: %pM, type: 0x%x, reason: %d, vdev: %d", |
| __func__, param->peermac.bytes, param->message_type, |
| param->peer_reason, param->vdev_id); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /** |
| * 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( |
| cmpl_params->pdev_id); |
| param->desc_id = cmpl_params->desc_id; |
| param->status = cmpl_params->status; |
| param->ppdu_id = cmpl_params->ppdu_id; |
| |
| 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( |
| 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\n", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| csa_status = param_buf->fixed_param; |
| |
| param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| 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_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]; |
| |
| 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; |
| } |
| |
| #ifdef CONVERGED_P2P_ENABLE |
| /** |
| * extract_p2p_noa_ev_param_tlv() - extract p2p noa information from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold p2p noa info |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_p2p_noa_ev_param_tlv( |
| wmi_unified_t wmi_handle, void *evt_buf, |
| struct p2p_noa_info *param) |
| { |
| WMI_P2P_NOA_EVENTID_param_tlvs *param_tlvs; |
| wmi_p2p_noa_event_fixed_param *fixed_param; |
| uint8_t i; |
| wmi_p2p_noa_info *wmi_noa_info; |
| uint8_t *buf_ptr; |
| uint32_t descriptors; |
| |
| param_tlvs = (WMI_P2P_NOA_EVENTID_param_tlvs *) evt_buf; |
| if (!param_tlvs) { |
| WMI_LOGE("%s: Invalid P2P NoA event buffer", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (!param) { |
| WMI_LOGE("noa information param is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| fixed_param = param_tlvs->fixed_param; |
| buf_ptr = (uint8_t *) fixed_param; |
| buf_ptr += sizeof(wmi_p2p_noa_event_fixed_param); |
| wmi_noa_info = (wmi_p2p_noa_info *) (buf_ptr); |
| |
| if (!WMI_UNIFIED_NOA_ATTR_IS_MODIFIED(wmi_noa_info)) { |
| WMI_LOGE("%s: noa attr is not modified", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| param->vdev_id = fixed_param->vdev_id; |
| param->index = |
| (uint8_t) WMI_UNIFIED_NOA_ATTR_INDEX_GET(wmi_noa_info); |
| param->opps_ps = |
| (uint8_t) WMI_UNIFIED_NOA_ATTR_OPP_PS_GET(wmi_noa_info); |
| param->ct_window = |
| (uint8_t) WMI_UNIFIED_NOA_ATTR_CTWIN_GET(wmi_noa_info); |
| descriptors = WMI_UNIFIED_NOA_ATTR_NUM_DESC_GET(wmi_noa_info); |
| param->num_desc = (uint8_t) descriptors; |
| if (param->num_desc > WMI_P2P_MAX_NOA_DESCRIPTORS) { |
| WMI_LOGE("%s: invalid num desc:%d", __func__, |
| param->num_desc); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| WMI_LOGD("%s:index %u, opps_ps %u, ct_window %u, num_descriptors = %u", __func__, |
| param->index, param->opps_ps, param->ct_window, |
| param->num_desc); |
| for (i = 0; i < param->num_desc; i++) { |
| param->noa_desc[i].type_count = |
| (uint8_t) wmi_noa_info->noa_descriptors[i]. |
| type_count; |
| param->noa_desc[i].duration = |
| wmi_noa_info->noa_descriptors[i].duration; |
| param->noa_desc[i].interval = |
| wmi_noa_info->noa_descriptors[i].interval; |
| param->noa_desc[i].start_time = |
| wmi_noa_info->noa_descriptors[i].start_time; |
| WMI_LOGD("%s:NoA descriptor[%d] type_count %u, duration %u, interval %u, start_time = %u", |
| __func__, i, param->noa_desc[i].type_count, |
| param->noa_desc[i].duration, |
| param->noa_desc[i].interval, |
| param->noa_desc[i].start_time); |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef FEATURE_P2P_LISTEN_OFFLOAD |
| /** |
| * extract_p2p_lo_stop_ev_param_tlv() - extract p2p lo stop |
| * information from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold p2p lo stop event information |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_p2p_lo_stop_ev_param_tlv( |
| wmi_unified_t wmi_handle, void *evt_buf, |
| struct p2p_lo_event *param) |
| { |
| WMI_P2P_LISTEN_OFFLOAD_STOPPED_EVENTID_param_tlvs *param_tlvs; |
| wmi_p2p_lo_stopped_event_fixed_param *lo_param; |
| |
| param_tlvs = (WMI_P2P_LISTEN_OFFLOAD_STOPPED_EVENTID_param_tlvs *) |
| evt_buf; |
| if (!param_tlvs) { |
| WMI_LOGE("%s: Invalid P2P lo stop event buffer", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (!param) { |
| WMI_LOGE("lo stop event param is null"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| lo_param = param_tlvs->fixed_param; |
| param->vdev_id = lo_param->vdev_id; |
| param->reason_code = lo_param->reason; |
| WMI_LOGD("%s: vdev_id:%d, reason:%d", __func__, |
| param->vdev_id, param->reason_code); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| #endif /* End of CONVERGED_P2P_ENABLE */ |
| |
| /** |
| * 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; |
| } |
| |
| /** |
| * extract_all_stats_counts_tlv() - extract all stats count from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param stats_param: Pointer to hold stats count |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_all_stats_counts_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, wmi_host_stats_event *stats_param) |
| { |
| wmi_stats_event_fixed_param *ev; |
| wmi_per_chain_rssi_stats *rssi_event; |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| uint64_t min_data_len; |
| |
| qdf_mem_zero(stats_param, sizeof(*stats_param)); |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| ev = (wmi_stats_event_fixed_param *) param_buf->fixed_param; |
| rssi_event = param_buf->chain_stats; |
| if (!ev) { |
| WMI_LOGE("%s: event fixed param NULL\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (param_buf->num_data > WMI_SVC_MSG_MAX_SIZE - sizeof(*ev)) { |
| WMI_LOGE("num_data : %u is invalid", param_buf->num_data); |
| return QDF_STATUS_E_FAULT; |
| } |
| |
| switch (ev->stats_id) { |
| case WMI_REQUEST_PEER_STAT: |
| stats_param->stats_id = WMI_HOST_REQUEST_PEER_STAT; |
| break; |
| |
| case WMI_REQUEST_AP_STAT: |
| stats_param->stats_id = WMI_HOST_REQUEST_AP_STAT; |
| break; |
| |
| case WMI_REQUEST_PDEV_STAT: |
| stats_param->stats_id = WMI_HOST_REQUEST_PDEV_STAT; |
| break; |
| |
| case WMI_REQUEST_VDEV_STAT: |
| stats_param->stats_id = WMI_HOST_REQUEST_VDEV_STAT; |
| break; |
| |
| case WMI_REQUEST_BCNFLT_STAT: |
| stats_param->stats_id = WMI_HOST_REQUEST_BCNFLT_STAT; |
| break; |
| |
| case WMI_REQUEST_VDEV_RATE_STAT: |
| stats_param->stats_id = WMI_HOST_REQUEST_VDEV_RATE_STAT; |
| break; |
| |
| case WMI_REQUEST_BCN_STAT: |
| stats_param->stats_id |= WMI_HOST_REQUEST_BCN_STAT; |
| break; |
| |
| default: |
| stats_param->stats_id = 0; |
| break; |
| |
| } |
| |
| /* ev->num_*_stats may cause uint32_t overflow, so use uint64_t |
| * to save total length calculated |
| */ |
| min_data_len = |
| (((uint64_t)ev->num_pdev_stats) * sizeof(wmi_pdev_stats)) + |
| (((uint64_t)ev->num_vdev_stats) * sizeof(wmi_vdev_stats)) + |
| (((uint64_t)ev->num_peer_stats) * sizeof(wmi_peer_stats)) + |
| (((uint64_t)ev->num_bcnflt_stats) * |
| sizeof(wmi_bcnfilter_stats_t)) + |
| (((uint64_t)ev->num_chan_stats) * sizeof(wmi_chan_stats)) + |
| (((uint64_t)ev->num_mib_stats) * sizeof(wmi_mib_stats)) + |
| (((uint64_t)ev->num_bcn_stats) * sizeof(wmi_bcn_stats)) + |
| (((uint64_t)ev->num_peer_extd_stats) * |
| sizeof(wmi_peer_extd_stats)); |
| if (param_buf->num_data != min_data_len) { |
| WMI_LOGE("data len: %u isn't same as calculated: %llu", |
| param_buf->num_data, min_data_len); |
| return QDF_STATUS_E_FAULT; |
| } |
| |
| stats_param->num_pdev_stats = ev->num_pdev_stats; |
| stats_param->num_pdev_ext_stats = 0; |
| stats_param->num_vdev_stats = ev->num_vdev_stats; |
| stats_param->num_peer_stats = ev->num_peer_stats; |
| stats_param->num_bcnflt_stats = ev->num_bcnflt_stats; |
| stats_param->num_chan_stats = ev->num_chan_stats; |
| stats_param->num_bcn_stats = ev->num_bcn_stats; |
| stats_param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| ev->pdev_id); |
| |
| /* if chain_stats is not populated */ |
| if (!param_buf->chain_stats || !param_buf->num_chain_stats) |
| return QDF_STATUS_SUCCESS; |
| |
| if (WMITLV_TAG_STRUC_wmi_per_chain_rssi_stats != |
| WMITLV_GET_TLVTAG(rssi_event->tlv_header)) |
| return QDF_STATUS_SUCCESS; |
| |
| if (WMITLV_GET_STRUCT_TLVLEN(wmi_per_chain_rssi_stats) != |
| WMITLV_GET_TLVLEN(rssi_event->tlv_header)) |
| return QDF_STATUS_SUCCESS; |
| |
| stats_param->num_rssi_stats = rssi_event->num_per_chain_rssi_stats; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_pdev_tx_stats() - extract pdev tx stats from event |
| */ |
| static void extract_pdev_tx_stats(wmi_host_dbg_tx_stats *tx, struct wlan_dbg_tx_stats *tx_stats) |
| { |
| /* Tx Stats */ |
| tx->comp_queued = tx_stats->comp_queued; |
| tx->comp_delivered = tx_stats->comp_delivered; |
| tx->msdu_enqued = tx_stats->msdu_enqued; |
| tx->mpdu_enqued = tx_stats->mpdu_enqued; |
| tx->wmm_drop = tx_stats->wmm_drop; |
| tx->local_enqued = tx_stats->local_enqued; |
| tx->local_freed = tx_stats->local_freed; |
| tx->hw_queued = tx_stats->hw_queued; |
| tx->hw_reaped = tx_stats->hw_reaped; |
| tx->underrun = tx_stats->underrun; |
| tx->tx_abort = tx_stats->tx_abort; |
| tx->mpdus_requed = tx_stats->mpdus_requed; |
| tx->data_rc = tx_stats->data_rc; |
| tx->self_triggers = tx_stats->self_triggers; |
| tx->sw_retry_failure = tx_stats->sw_retry_failure; |
| tx->illgl_rate_phy_err = tx_stats->illgl_rate_phy_err; |
| tx->pdev_cont_xretry = tx_stats->pdev_cont_xretry; |
| tx->pdev_tx_timeout = tx_stats->pdev_tx_timeout; |
| tx->pdev_resets = tx_stats->pdev_resets; |
| tx->stateless_tid_alloc_failure = tx_stats->stateless_tid_alloc_failure; |
| tx->phy_underrun = tx_stats->phy_underrun; |
| tx->txop_ovf = tx_stats->txop_ovf; |
| |
| return; |
| } |
| |
| |
| /** |
| * extract_pdev_rx_stats() - extract pdev rx stats from event |
| */ |
| static void extract_pdev_rx_stats(wmi_host_dbg_rx_stats *rx, struct wlan_dbg_rx_stats *rx_stats) |
| { |
| /* Rx Stats */ |
| rx->mid_ppdu_route_change = rx_stats->mid_ppdu_route_change; |
| rx->status_rcvd = rx_stats->status_rcvd; |
| rx->r0_frags = rx_stats->r0_frags; |
| rx->r1_frags = rx_stats->r1_frags; |
| rx->r2_frags = rx_stats->r2_frags; |
| /* Only TLV */ |
| rx->r3_frags = 0; |
| rx->htt_msdus = rx_stats->htt_msdus; |
| rx->htt_mpdus = rx_stats->htt_mpdus; |
| rx->loc_msdus = rx_stats->loc_msdus; |
| rx->loc_mpdus = rx_stats->loc_mpdus; |
| rx->oversize_amsdu = rx_stats->oversize_amsdu; |
| rx->phy_errs = rx_stats->phy_errs; |
| rx->phy_err_drop = rx_stats->phy_err_drop; |
| rx->mpdu_errs = rx_stats->mpdu_errs; |
| |
| return; |
| } |
| |
| /** |
| * extract_pdev_stats_tlv() - extract pdev stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into pdev stats |
| * @param pdev_stats: Pointer to hold pdev stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_pdev_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_pdev_stats *pdev_stats) |
| { |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_stats_event_fixed_param *ev_param; |
| uint8_t *data; |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| ev_param = (wmi_stats_event_fixed_param *) param_buf->fixed_param; |
| |
| data = param_buf->data; |
| |
| if (index < ev_param->num_pdev_stats) { |
| wmi_pdev_stats *ev = (wmi_pdev_stats *) ((data) + |
| (index * sizeof(wmi_pdev_stats))); |
| |
| pdev_stats->chan_nf = ev->chan_nf; |
| pdev_stats->tx_frame_count = ev->tx_frame_count; |
| pdev_stats->rx_frame_count = ev->rx_frame_count; |
| pdev_stats->rx_clear_count = ev->rx_clear_count; |
| pdev_stats->cycle_count = ev->cycle_count; |
| pdev_stats->phy_err_count = ev->phy_err_count; |
| pdev_stats->chan_tx_pwr = ev->chan_tx_pwr; |
| |
| extract_pdev_tx_stats(&(pdev_stats->pdev_stats.tx), |
| &(ev->pdev_stats.tx)); |
| extract_pdev_rx_stats(&(pdev_stats->pdev_stats.rx), |
| &(ev->pdev_stats.rx)); |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_unit_test_tlv() - extract unit test data |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param unit_test: pointer to hold unit test data |
| * @param maxspace: Amount of space in evt_buf |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_unit_test_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, wmi_unit_test_event *unit_test, uint32_t maxspace) |
| { |
| WMI_UNIT_TEST_EVENTID_param_tlvs *param_buf; |
| wmi_unit_test_event_fixed_param *ev_param; |
| uint32_t num_bufp; |
| uint32_t copy_size; |
| uint8_t *bufp; |
| |
| param_buf = (WMI_UNIT_TEST_EVENTID_param_tlvs *) evt_buf; |
| ev_param = param_buf->fixed_param; |
| bufp = param_buf->bufp; |
| num_bufp = param_buf->num_bufp; |
| unit_test->vdev_id = ev_param->vdev_id; |
| unit_test->module_id = ev_param->module_id; |
| unit_test->diag_token = ev_param->diag_token; |
| unit_test->flag = ev_param->flag; |
| unit_test->payload_len = ev_param->payload_len; |
| WMI_LOGI("%s:vdev_id:%d mod_id:%d diag_token:%d flag:%d\n", __func__, |
| ev_param->vdev_id, |
| ev_param->module_id, |
| ev_param->diag_token, |
| ev_param->flag); |
| WMI_LOGD("%s: Unit-test data given below %d", __func__, num_bufp); |
| qdf_trace_hex_dump(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG, |
| bufp, num_bufp); |
| copy_size = (num_bufp < maxspace) ? num_bufp : maxspace; |
| qdf_mem_copy(unit_test->buffer, bufp, copy_size); |
| unit_test->buffer_len = copy_size; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_pdev_ext_stats_tlv() - extract extended pdev stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into extended pdev stats |
| * @param pdev_ext_stats: Pointer to hold extended pdev stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_pdev_ext_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_pdev_ext_stats *pdev_ext_stats) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_vdev_stats_tlv() - extract vdev stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into vdev stats |
| * @param vdev_stats: Pointer to hold vdev stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_vdev_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_vdev_stats *vdev_stats) |
| { |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_stats_event_fixed_param *ev_param; |
| uint8_t *data; |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| ev_param = (wmi_stats_event_fixed_param *) param_buf->fixed_param; |
| data = (uint8_t *) param_buf->data; |
| |
| if (index < ev_param->num_vdev_stats) { |
| wmi_vdev_stats *ev = (wmi_vdev_stats *) ((data) + |
| ((ev_param->num_pdev_stats) * |
| sizeof(wmi_pdev_stats)) + |
| (index * sizeof(wmi_vdev_stats))); |
| |
| vdev_stats->vdev_id = ev->vdev_id; |
| vdev_stats->vdev_snr.bcn_snr = ev->vdev_snr.bcn_snr; |
| vdev_stats->vdev_snr.dat_snr = ev->vdev_snr.dat_snr; |
| |
| OS_MEMCPY(vdev_stats->tx_frm_cnt, ev->tx_frm_cnt, |
| sizeof(ev->tx_frm_cnt)); |
| vdev_stats->rx_frm_cnt = ev->rx_frm_cnt; |
| OS_MEMCPY(vdev_stats->multiple_retry_cnt, |
| ev->multiple_retry_cnt, |
| sizeof(ev->multiple_retry_cnt)); |
| OS_MEMCPY(vdev_stats->fail_cnt, ev->fail_cnt, |
| sizeof(ev->fail_cnt)); |
| vdev_stats->rts_fail_cnt = ev->rts_fail_cnt; |
| vdev_stats->rts_succ_cnt = ev->rts_succ_cnt; |
| vdev_stats->rx_err_cnt = ev->rx_err_cnt; |
| vdev_stats->rx_discard_cnt = ev->rx_discard_cnt; |
| vdev_stats->ack_fail_cnt = ev->ack_fail_cnt; |
| OS_MEMCPY(vdev_stats->tx_rate_history, ev->tx_rate_history, |
| sizeof(ev->tx_rate_history)); |
| OS_MEMCPY(vdev_stats->bcn_rssi_history, ev->bcn_rssi_history, |
| sizeof(ev->bcn_rssi_history)); |
| |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_per_chain_rssi_stats_tlv() - api to extract rssi stats from event |
| * buffer |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @index: Index into vdev stats |
| * @rssi_stats: Pointer to hold rssi stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_per_chain_rssi_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, |
| struct wmi_host_per_chain_rssi_stats *rssi_stats) |
| { |
| uint8_t *data; |
| wmi_rssi_stats *fw_rssi_stats; |
| wmi_per_chain_rssi_stats *rssi_event; |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| |
| if (!evt_buf) { |
| WMI_LOGE("evt_buf is null"); |
| return QDF_STATUS_E_NULL_VALUE; |
| } |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| rssi_event = param_buf->chain_stats; |
| |
| if (index >= rssi_event->num_per_chain_rssi_stats) { |
| WMI_LOGE("invalid index"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| data = ((uint8_t *)(&rssi_event[1])) + WMI_TLV_HDR_SIZE; |
| fw_rssi_stats = &((wmi_rssi_stats *)data)[index]; |
| |
| rssi_stats->vdev_id = fw_rssi_stats->vdev_id; |
| qdf_mem_copy(rssi_stats->rssi_avg_beacon, |
| fw_rssi_stats->rssi_avg_beacon, |
| sizeof(fw_rssi_stats->rssi_avg_beacon)); |
| qdf_mem_copy(rssi_stats->rssi_avg_data, |
| fw_rssi_stats->rssi_avg_data, |
| sizeof(fw_rssi_stats->rssi_avg_data)); |
| qdf_mem_copy(&rssi_stats->peer_macaddr, |
| &fw_rssi_stats->peer_macaddr, |
| sizeof(fw_rssi_stats->peer_macaddr)); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| |
| |
| /** |
| * extract_bcn_stats_tlv() - extract bcn stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into vdev stats |
| * @param bcn_stats: Pointer to hold bcn stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_bcn_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_bcn_stats *bcn_stats) |
| { |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_stats_event_fixed_param *ev_param; |
| uint8_t *data; |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| ev_param = (wmi_stats_event_fixed_param *) param_buf->fixed_param; |
| data = (uint8_t *) param_buf->data; |
| |
| if (index < ev_param->num_bcn_stats) { |
| wmi_bcn_stats *ev = (wmi_bcn_stats *) ((data) + |
| ((ev_param->num_pdev_stats) * sizeof(wmi_pdev_stats)) + |
| ((ev_param->num_vdev_stats) * sizeof(wmi_vdev_stats)) + |
| ((ev_param->num_peer_stats) * sizeof(wmi_peer_stats)) + |
| ((ev_param->num_chan_stats) * sizeof(wmi_chan_stats)) + |
| ((ev_param->num_mib_stats) * sizeof(wmi_mib_stats)) + |
| (index * sizeof(wmi_bcn_stats))); |
| |
| bcn_stats->vdev_id = ev->vdev_id; |
| bcn_stats->tx_bcn_succ_cnt = ev->tx_bcn_succ_cnt; |
| bcn_stats->tx_bcn_outage_cnt = ev->tx_bcn_outage_cnt; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_peer_stats_tlv() - extract peer stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into peer stats |
| * @param peer_stats: Pointer to hold peer stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_peer_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_peer_stats *peer_stats) |
| { |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_stats_event_fixed_param *ev_param; |
| uint8_t *data; |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| ev_param = (wmi_stats_event_fixed_param *) param_buf->fixed_param; |
| data = (uint8_t *) param_buf->data; |
| |
| if (index < ev_param->num_peer_stats) { |
| wmi_peer_stats *ev = (wmi_peer_stats *) ((data) + |
| ((ev_param->num_pdev_stats) * sizeof(wmi_pdev_stats)) + |
| ((ev_param->num_vdev_stats) * sizeof(wmi_vdev_stats)) + |
| (index * sizeof(wmi_peer_stats))); |
| |
| OS_MEMSET(peer_stats, 0, sizeof(wmi_host_peer_stats)); |
| |
| OS_MEMCPY(&(peer_stats->peer_macaddr), |
| &(ev->peer_macaddr), sizeof(wmi_mac_addr)); |
| |
| peer_stats->peer_rssi = ev->peer_rssi; |
| peer_stats->peer_tx_rate = ev->peer_tx_rate; |
| peer_stats->peer_rx_rate = ev->peer_rx_rate; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_bcnflt_stats_tlv() - extract bcn fault stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into bcn fault stats |
| * @param bcnflt_stats: Pointer to hold bcn fault stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_bcnflt_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_bcnflt_stats *peer_stats) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_peer_extd_stats_tlv() - extract extended peer stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into extended peer stats |
| * @param peer_extd_stats: Pointer to hold extended peer stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_peer_extd_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, |
| wmi_host_peer_extd_stats *peer_extd_stats) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_chan_stats_tlv() - extract chan stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param index: Index into chan stats |
| * @param vdev_extd_stats: Pointer to hold chan stats |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_chan_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t index, wmi_host_chan_stats *chan_stats) |
| { |
| WMI_UPDATE_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_stats_event_fixed_param *ev_param; |
| uint8_t *data; |
| |
| param_buf = (WMI_UPDATE_STATS_EVENTID_param_tlvs *) evt_buf; |
| ev_param = (wmi_stats_event_fixed_param *) param_buf->fixed_param; |
| data = (uint8_t *) param_buf->data; |
| |
| if (index < ev_param->num_chan_stats) { |
| wmi_chan_stats *ev = (wmi_chan_stats *) ((data) + |
| ((ev_param->num_pdev_stats) * sizeof(wmi_pdev_stats)) + |
| ((ev_param->num_vdev_stats) * sizeof(wmi_vdev_stats)) + |
| ((ev_param->num_peer_stats) * sizeof(wmi_peer_stats)) + |
| (index * sizeof(wmi_chan_stats))); |
| |
| |
| /* Non-TLV doesn't have num_chan_stats */ |
| chan_stats->chan_mhz = ev->chan_mhz; |
| chan_stats->sampling_period_us = ev->sampling_period_us; |
| chan_stats->rx_clear_count = ev->rx_clear_count; |
| chan_stats->tx_duration_us = ev->tx_duration_us; |
| chan_stats->rx_duration_us = ev->rx_duration_us; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_profile_ctx_tlv() - extract profile context from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @idx: profile stats index to extract |
| * @param profile_ctx: Pointer to hold profile context |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_profile_ctx_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, wmi_host_wlan_profile_ctx_t *profile_ctx) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_profile_data_tlv() - extract profile data from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param profile_data: Pointer to hold profile data |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_profile_data_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint8_t idx, wmi_host_wlan_profile_t *profile_data) |
| { |
| |
| 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\n", __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; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_pdev_utf_event_tlv() - extract UTF data info from event |
| * @wmi_handle: WMI handle |
| * @param evt_buf: Pointer to event buffer |
| * @param param: Pointer to hold data |
| * |
| * Return : QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_pdev_utf_event_tlv(wmi_unified_t wmi_handle, |
| uint8_t *evt_buf, |
| struct wmi_host_pdev_utf_event *event) |
| { |
| WMI_PDEV_UTF_EVENTID_param_tlvs *param_buf; |
| struct wmi_host_utf_seg_header_info *seg_hdr; |
| |
| param_buf = (WMI_PDEV_UTF_EVENTID_param_tlvs *)evt_buf; |
| event->data = param_buf->data; |
| event->datalen = param_buf->num_data; |
| |
| if (event->datalen < sizeof(struct wmi_host_utf_seg_header_info)) { |
| WMI_LOGE("%s: Invalid datalen: %d ", __func__, event->datalen); |
| return QDF_STATUS_E_INVAL; |
| } |
| seg_hdr = (struct wmi_host_utf_seg_header_info *)param_buf->data; |
| /* Set pdev_id=1 until FW adds support to include pdev_id */ |
| event->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| seg_hdr->pdev_id); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_chainmask_tables_tlv() - extract chain mask tables from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold evt buf |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_chainmask_tables_tlv(wmi_unified_t wmi_handle, |
| uint8_t *event, struct wlan_psoc_host_chainmask_table *chainmask_table) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| WMI_MAC_PHY_CHAINMASK_CAPABILITY *chainmask_caps; |
| WMI_SOC_MAC_PHY_HW_MODE_CAPS *hw_caps; |
| uint8_t i = 0, j = 0; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *) event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| hw_caps = param_buf->soc_hw_mode_caps; |
| if (!hw_caps) |
| return QDF_STATUS_E_INVAL; |
| |
| if (!hw_caps->num_chainmask_tables) |
| return QDF_STATUS_E_INVAL; |
| |
| chainmask_caps = param_buf->mac_phy_chainmask_caps; |
| |
| if (chainmask_caps == NULL) |
| return QDF_STATUS_E_INVAL; |
| |
| for (i = 0; i < hw_caps->num_chainmask_tables; i++) { |
| |
| qdf_print("Dumping chain mask combo data for table : %d", i); |
| for (j = 0; j < chainmask_table[i].num_valid_chainmasks; j++) { |
| |
| chainmask_table[i].cap_list[j].chainmask = |
| chainmask_caps->chainmask; |
| |
| chainmask_table[i].cap_list[j].supports_chan_width_20 = |
| WMI_SUPPORT_CHAN_WIDTH_20_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].supports_chan_width_40 = |
| WMI_SUPPORT_CHAN_WIDTH_40_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].supports_chan_width_80 = |
| WMI_SUPPORT_CHAN_WIDTH_80_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].supports_chan_width_160 = |
| WMI_SUPPORT_CHAN_WIDTH_160_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].supports_chan_width_80P80 = |
| WMI_SUPPORT_CHAN_WIDTH_80P80_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].chain_mask_2G = |
| WMI_SUPPORT_CHAIN_MASK_2G_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].chain_mask_5G = |
| WMI_SUPPORT_CHAIN_MASK_5G_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].chain_mask_tx = |
| WMI_SUPPORT_CHAIN_MASK_TX_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].chain_mask_rx = |
| WMI_SUPPORT_CHAIN_MASK_RX_GET(chainmask_caps->supported_flags); |
| |
| chainmask_table[i].cap_list[j].supports_aDFS = |
| WMI_SUPPORT_CHAIN_MASK_ADFS_GET(chainmask_caps->supported_flags); |
| |
| qdf_print("supported_flags: 0x%08x chainmasks: 0x%08x", |
| chainmask_caps->supported_flags, |
| chainmask_caps->chainmask |
| ); |
| chainmask_caps++; |
| } |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_service_ready_ext_tlv() - extract basic extended service ready params |
| * from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold evt buf |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_service_ready_ext_tlv(wmi_unified_t wmi_handle, |
| uint8_t *event, struct wlan_psoc_host_service_ext_param *param) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| wmi_service_ready_ext_event_fixed_param *ev; |
| WMI_SOC_MAC_PHY_HW_MODE_CAPS *hw_caps; |
| WMI_SOC_HAL_REG_CAPABILITIES *reg_caps; |
| WMI_MAC_PHY_CHAINMASK_COMBO *chain_mask_combo; |
| uint8_t i = 0; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *) event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| ev = param_buf->fixed_param; |
| if (!ev) |
| return QDF_STATUS_E_INVAL; |
| |
| /* Move this to host based bitmap */ |
| param->default_conc_scan_config_bits = |
| ev->default_conc_scan_config_bits; |
| param->default_fw_config_bits = ev->default_fw_config_bits; |
| param->he_cap_info = ev->he_cap_info; |
| param->mpdu_density = ev->mpdu_density; |
| param->max_bssid_rx_filters = ev->max_bssid_rx_filters; |
| param->fw_build_vers_ext = ev->fw_build_vers_ext; |
| param->num_dbr_ring_caps = param_buf->num_dma_ring_caps; |
| param->max_bssid_indicator = ev->max_bssid_indicator; |
| qdf_mem_copy(¶m->ppet, &ev->ppet, sizeof(param->ppet)); |
| |
| hw_caps = param_buf->soc_hw_mode_caps; |
| if (hw_caps) |
| param->num_hw_modes = hw_caps->num_hw_modes; |
| else |
| param->num_hw_modes = 0; |
| |
| reg_caps = param_buf->soc_hal_reg_caps; |
| if (reg_caps) |
| param->num_phy = reg_caps->num_phy; |
| else |
| param->num_phy = 0; |
| |
| if (hw_caps) { |
| param->num_chainmask_tables = hw_caps->num_chainmask_tables; |
| qdf_print("Num chain mask tables: %d", hw_caps->num_chainmask_tables); |
| } else |
| param->num_chainmask_tables = 0; |
| |
| chain_mask_combo = param_buf->mac_phy_chainmask_combo; |
| |
| if (chain_mask_combo == NULL) |
| return QDF_STATUS_SUCCESS; |
| |
| qdf_print("Dumping chain mask combo data"); |
| |
| for (i = 0; i < param->num_chainmask_tables; i++) { |
| |
| qdf_print("table_id : %d Num valid chainmasks: %d", |
| chain_mask_combo->chainmask_table_id, |
| chain_mask_combo->num_valid_chainmask |
| ); |
| |
| param->chainmask_table[i].table_id = |
| chain_mask_combo->chainmask_table_id; |
| param->chainmask_table[i].num_valid_chainmasks = |
| chain_mask_combo->num_valid_chainmask; |
| chain_mask_combo++; |
| } |
| qdf_print("chain mask combo end"); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_sar_cap_service_ready_ext_tlv() - |
| * extract SAR cap from service ready event |
| * @wmi_handle: wmi handle |
| * @event: pointer to event buffer |
| * @ext_param: extended target info |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_sar_cap_service_ready_ext_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *event, |
| struct wlan_psoc_host_service_ext_param *ext_param) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| WMI_SAR_CAPABILITIES *sar_caps; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *)event; |
| |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| sar_caps = param_buf->sar_caps; |
| if (sar_caps) |
| ext_param->sar_version = sar_caps->active_version; |
| else |
| ext_param->sar_version = 0; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_hw_mode_cap_service_ready_ext_tlv() - |
| * extract HW mode cap from service ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold evt buf |
| * @param hw_mode_idx: hw mode idx should be less than num_mode |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_hw_mode_cap_service_ready_ext_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *event, uint8_t hw_mode_idx, |
| struct wlan_psoc_host_hw_mode_caps *param) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| WMI_SOC_MAC_PHY_HW_MODE_CAPS *hw_caps; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *) event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| hw_caps = param_buf->soc_hw_mode_caps; |
| if (!hw_caps) |
| return QDF_STATUS_E_INVAL; |
| |
| if (hw_mode_idx >= hw_caps->num_hw_modes) |
| return QDF_STATUS_E_INVAL; |
| |
| param->hw_mode_id = param_buf->hw_mode_caps[hw_mode_idx].hw_mode_id; |
| param->phy_id_map = param_buf->hw_mode_caps[hw_mode_idx].phy_id_map; |
| |
| param->hw_mode_config_type = |
| param_buf->hw_mode_caps[hw_mode_idx].hw_mode_config_type; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_mac_phy_cap_service_ready_ext_tlv() - |
| * extract MAC phy cap from service ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold evt buf |
| * @param hw_mode_idx: hw mode idx should be less than num_mode |
| * @param phy_id: phy id within hw_mode |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_mac_phy_cap_service_ready_ext_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *event, uint8_t hw_mode_id, uint8_t phy_id, |
| struct wlan_psoc_host_mac_phy_caps *param) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| WMI_MAC_PHY_CAPABILITIES *mac_phy_caps; |
| WMI_SOC_MAC_PHY_HW_MODE_CAPS *hw_caps; |
| uint32_t phy_map; |
| uint8_t hw_idx, phy_idx = 0; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *) event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| hw_caps = param_buf->soc_hw_mode_caps; |
| if (!hw_caps) |
| return QDF_STATUS_E_INVAL; |
| |
| for (hw_idx = 0; hw_idx < hw_caps->num_hw_modes; hw_idx++) { |
| if (hw_mode_id == param_buf->hw_mode_caps[hw_idx].hw_mode_id) |
| break; |
| |
| phy_map = param_buf->hw_mode_caps[hw_idx].phy_id_map; |
| while (phy_map) { |
| phy_map >>= 1; |
| phy_idx++; |
| } |
| } |
| |
| if (hw_idx == hw_caps->num_hw_modes) |
| return QDF_STATUS_E_INVAL; |
| |
| phy_idx += phy_id; |
| if (phy_idx >= param_buf->num_mac_phy_caps) |
| return QDF_STATUS_E_INVAL; |
| |
| mac_phy_caps = ¶m_buf->mac_phy_caps[phy_idx]; |
| |
| param->hw_mode_id = mac_phy_caps->hw_mode_id; |
| param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| mac_phy_caps->pdev_id); |
| param->phy_id = mac_phy_caps->phy_id; |
| param->supports_11b = |
| WMI_SUPPORT_11B_GET(mac_phy_caps->supported_flags); |
| param->supports_11g = |
| WMI_SUPPORT_11G_GET(mac_phy_caps->supported_flags); |
| param->supports_11a = |
| WMI_SUPPORT_11A_GET(mac_phy_caps->supported_flags); |
| param->supports_11n = |
| WMI_SUPPORT_11N_GET(mac_phy_caps->supported_flags); |
| param->supports_11ac = |
| WMI_SUPPORT_11AC_GET(mac_phy_caps->supported_flags); |
| param->supports_11ax = |
| WMI_SUPPORT_11AX_GET(mac_phy_caps->supported_flags); |
| |
| param->supported_bands = mac_phy_caps->supported_bands; |
| param->ampdu_density = mac_phy_caps->ampdu_density; |
| param->max_bw_supported_2G = mac_phy_caps->max_bw_supported_2G; |
| param->ht_cap_info_2G = mac_phy_caps->ht_cap_info_2G; |
| param->vht_cap_info_2G = mac_phy_caps->vht_cap_info_2G; |
| param->vht_supp_mcs_2G = mac_phy_caps->vht_supp_mcs_2G; |
| param->he_cap_info_2G[WMI_HOST_HECAP_MAC_WORD1] = |
| mac_phy_caps->he_cap_info_2G; |
| param->he_cap_info_2G[WMI_HOST_HECAP_MAC_WORD2] = |
| mac_phy_caps->he_cap_info_2G_ext; |
| param->he_supp_mcs_2G = mac_phy_caps->he_supp_mcs_2G; |
| param->tx_chain_mask_2G = mac_phy_caps->tx_chain_mask_2G; |
| param->rx_chain_mask_2G = mac_phy_caps->rx_chain_mask_2G; |
| param->max_bw_supported_5G = mac_phy_caps->max_bw_supported_5G; |
| param->ht_cap_info_5G = mac_phy_caps->ht_cap_info_5G; |
| param->vht_cap_info_5G = mac_phy_caps->vht_cap_info_5G; |
| param->vht_supp_mcs_5G = mac_phy_caps->vht_supp_mcs_5G; |
| param->he_cap_info_5G[WMI_HOST_HECAP_MAC_WORD1] = |
| mac_phy_caps->he_cap_info_5G; |
| param->he_cap_info_5G[WMI_HOST_HECAP_MAC_WORD2] = |
| mac_phy_caps->he_cap_info_5G_ext; |
| param->he_supp_mcs_5G = mac_phy_caps->he_supp_mcs_5G; |
| param->tx_chain_mask_5G = mac_phy_caps->tx_chain_mask_5G; |
| param->rx_chain_mask_5G = mac_phy_caps->rx_chain_mask_5G; |
| qdf_mem_copy(¶m->he_cap_phy_info_2G, |
| &mac_phy_caps->he_cap_phy_info_2G, |
| sizeof(param->he_cap_phy_info_2G)); |
| qdf_mem_copy(¶m->he_cap_phy_info_5G, |
| &mac_phy_caps->he_cap_phy_info_5G, |
| sizeof(param->he_cap_phy_info_5G)); |
| qdf_mem_copy(¶m->he_ppet2G, &mac_phy_caps->he_ppet2G, |
| sizeof(param->he_ppet2G)); |
| qdf_mem_copy(¶m->he_ppet5G, &mac_phy_caps->he_ppet5G, |
| sizeof(param->he_ppet5G)); |
| param->chainmask_table_id = mac_phy_caps->chainmask_table_id; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_reg_cap_service_ready_ext_tlv() - |
| * extract REG cap from service ready event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: Pointer to hold evt buf |
| * @param phy_idx: phy idx should be less than num_mode |
| * |
| * Return: QDF_STATUS_SUCCESS for success or error code |
| */ |
| static QDF_STATUS extract_reg_cap_service_ready_ext_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *event, uint8_t phy_idx, |
| struct wlan_psoc_host_hal_reg_capabilities_ext *param) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| WMI_SOC_HAL_REG_CAPABILITIES *reg_caps; |
| WMI_HAL_REG_CAPABILITIES_EXT *ext_reg_cap; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *) event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| reg_caps = param_buf->soc_hal_reg_caps; |
| if (!reg_caps) |
| return QDF_STATUS_E_INVAL; |
| |
| if (phy_idx >= reg_caps->num_phy) |
| return QDF_STATUS_E_INVAL; |
| |
| ext_reg_cap = ¶m_buf->hal_reg_caps[phy_idx]; |
| |
| param->phy_id = ext_reg_cap->phy_id; |
| param->eeprom_reg_domain = ext_reg_cap->eeprom_reg_domain; |
| param->eeprom_reg_domain_ext = ext_reg_cap->eeprom_reg_domain_ext; |
| param->regcap1 = ext_reg_cap->regcap1; |
| param->regcap2 = ext_reg_cap->regcap2; |
| param->wireless_modes = convert_wireless_modes_tlv( |
| ext_reg_cap->wireless_modes); |
| param->low_2ghz_chan = ext_reg_cap->low_2ghz_chan; |
| param->high_2ghz_chan = ext_reg_cap->high_2ghz_chan; |
| param->low_5ghz_chan = ext_reg_cap->low_5ghz_chan; |
| param->high_5ghz_chan = ext_reg_cap->high_5ghz_chan; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_dbr_ring_cap_service_ready_ext_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *event, uint8_t idx, |
| struct wlan_psoc_host_dbr_ring_caps *param) |
| { |
| WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *param_buf; |
| WMI_DMA_RING_CAPABILITIES *dbr_ring_caps; |
| |
| param_buf = (WMI_SERVICE_READY_EXT_EVENTID_param_tlvs *)event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| dbr_ring_caps = ¶m_buf->dma_ring_caps[idx]; |
| |
| param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| dbr_ring_caps->pdev_id); |
| param->mod_id = dbr_ring_caps->mod_id; |
| param->ring_elems_min = dbr_ring_caps->ring_elems_min; |
| param->min_buf_size = dbr_ring_caps->min_buf_size; |
| param->min_buf_align = dbr_ring_caps->min_buf_align; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_dbr_buf_release_fixed_tlv(wmi_unified_t wmi_handle, |
| uint8_t *event, struct direct_buf_rx_rsp *param) |
| { |
| WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID_param_tlvs *param_buf; |
| wmi_dma_buf_release_fixed_param *ev; |
| |
| param_buf = (WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID_param_tlvs *)event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| ev = param_buf->fixed_param; |
| if (!ev) |
| return QDF_STATUS_E_INVAL; |
| |
| param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| ev->pdev_id); |
| param->mod_id = ev->mod_id; |
| param->num_buf_release_entry = ev->num_buf_release_entry; |
| param->num_meta_data_entry = ev->num_meta_data_entry; |
| WMI_LOGD("%s:pdev id %d mod id %d num buf release entry %d\n", __func__, |
| param->pdev_id, param->mod_id, param->num_buf_release_entry); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_dbr_buf_release_entry_tlv(wmi_unified_t wmi_handle, |
| uint8_t *event, uint8_t idx, struct direct_buf_rx_entry *param) |
| { |
| WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID_param_tlvs *param_buf; |
| wmi_dma_buf_release_entry *entry; |
| |
| param_buf = (WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID_param_tlvs *)event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| entry = ¶m_buf->entries[idx]; |
| |
| if (!entry) { |
| WMI_LOGE("%s: Entry is NULL\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| WMI_LOGD("%s: paddr_lo[%d] = %x\n", __func__, idx, entry->paddr_lo); |
| |
| param->paddr_lo = entry->paddr_lo; |
| param->paddr_hi = entry->paddr_hi; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_dbr_buf_metadata_tlv( |
| wmi_unified_t wmi_handle, uint8_t *event, |
| uint8_t idx, struct direct_buf_rx_metadata *param) |
| { |
| WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID_param_tlvs *param_buf; |
| wmi_dma_buf_release_spectral_meta_data *entry; |
| |
| param_buf = (WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID_param_tlvs *)event; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| entry = ¶m_buf->meta_data[idx]; |
| |
| if (!entry) { |
| WMI_LOGE("%s: Entry is NULL\n", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| qdf_mem_copy(param->noisefloor, entry->noise_floor, |
| sizeof(entry->noise_floor)); |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * 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( |
| 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_thermal_stats_tlv() - extract thermal stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: Pointer to event buffer |
| * @param temp: Pointer to hold extracted temperature |
| * @param level: Pointer to hold extracted level |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| extract_thermal_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint32_t *temp, |
| uint32_t *level, uint32_t *pdev_id) |
| { |
| WMI_THERM_THROT_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_therm_throt_stats_event_fixed_param *tt_stats_event; |
| |
| param_buf = |
| (WMI_THERM_THROT_STATS_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| tt_stats_event = param_buf->fixed_param; |
| |
| *pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| tt_stats_event->pdev_id); |
| *temp = tt_stats_event->temp; |
| *level = tt_stats_event->level; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_thermal_level_stats_tlv() - extract thermal level stats from event |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param idx: Index to level stats |
| * @param levelcount: Pointer to hold levelcount |
| * @param dccount: Pointer to hold dccount |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS |
| extract_thermal_level_stats_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, uint8_t idx, uint32_t *levelcount, |
| uint32_t *dccount) |
| { |
| WMI_THERM_THROT_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_therm_throt_level_stats_info *tt_level_info; |
| |
| param_buf = |
| (WMI_THERM_THROT_STATS_EVENTID_param_tlvs *) evt_buf; |
| if (!param_buf) |
| return QDF_STATUS_E_INVAL; |
| |
| tt_level_info = param_buf->therm_throt_level_stats_info; |
| |
| if (idx < THERMAL_LEVELS) { |
| *levelcount = tt_level_info[idx].level_count; |
| *dccount = tt_level_info[idx].dc_count; |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| return QDF_STATUS_E_FAILURE; |
| } |
| #ifdef BIG_ENDIAN_HOST |
| /** |
| * fips_conv_data_be() - LE to BE conversion of FIPS ev data |
| * @param data_len - data length |
| * @param data - pointer to data |
| * |
| * Return: QDF_STATUS - success or error status |
| */ |
| static QDF_STATUS fips_conv_data_be(uint32_t data_len, uint8_t *data) |
| { |
| uint8_t *data_aligned = NULL; |
| int c; |
| unsigned char *data_unaligned; |
| |
| data_unaligned = qdf_mem_malloc(((sizeof(uint8_t) * data_len) + |
| FIPS_ALIGN)); |
| /* Assigning unaligned space to copy the data */ |
| /* Checking if kmalloc does successful allocation */ |
| if (data_unaligned == NULL) |
| return QDF_STATUS_E_FAILURE; |
| |
| /* Checking if space is alligned */ |
| if (!FIPS_IS_ALIGNED(data_unaligned, FIPS_ALIGN)) { |
| /* align the data space */ |
| data_aligned = |
| (uint8_t *)FIPS_ALIGNTO(data_unaligned, FIPS_ALIGN); |
| } else { |
| data_aligned = (u_int8_t *)data_unaligned; |
| } |
| |
| /* memset and copy content from data to data aligned */ |
| OS_MEMSET(data_aligned, 0, data_len); |
| OS_MEMCPY(data_aligned, data, data_len); |
| /* Endianness to LE */ |
| for (c = 0; c < data_len/4; c++) { |
| *((u_int32_t *)data_aligned + c) = |
| qdf_le32_to_cpu(*((u_int32_t *)data_aligned + c)); |
| } |
| |
| /* Copy content to event->data */ |
| OS_MEMCPY(data, data_aligned, data_len); |
| |
| /* clean up allocated space */ |
| qdf_mem_free(data_unaligned); |
| data_aligned = NULL; |
| data_unaligned = NULL; |
| |
| /*************************************************************/ |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #else |
| /** |
| * fips_conv_data_be() - DUMMY for LE platform |
| * |
| * Return: QDF_STATUS - success |
| */ |
| static QDF_STATUS fips_conv_data_be(uint32_t data_len, uint8_t *data) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /** |
| * extract_fips_event_data_tlv() - extract fips event data |
| * @wmi_handle: wmi handle |
| * @param evt_buf: pointer to event buffer |
| * @param param: pointer FIPS event params |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS extract_fips_event_data_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct wmi_host_fips_event_param *param) |
| { |
| WMI_PDEV_FIPS_EVENTID_param_tlvs *param_buf; |
| wmi_pdev_fips_event_fixed_param *event; |
| |
| param_buf = (WMI_PDEV_FIPS_EVENTID_param_tlvs *) evt_buf; |
| event = (wmi_pdev_fips_event_fixed_param *) param_buf->fixed_param; |
| |
| if (fips_conv_data_be(event->data_len, param_buf->data) != |
| QDF_STATUS_SUCCESS) |
| return QDF_STATUS_E_FAILURE; |
| |
| param->data = (uint32_t *)param_buf->data; |
| param->data_len = event->data_len; |
| param->error_status = event->error_status; |
| param->pdev_id = wmi_handle->ops->convert_pdev_id_target_to_host( |
| event->pdev_id); |
| |
| 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\n", __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; |
| } |
| |
| static bool is_management_record_tlv(uint32_t cmd_id) |
| { |
| if ((cmd_id == WMI_MGMT_TX_COMPLETION_EVENTID) || |
| (cmd_id == WMI_MGMT_TX_SEND_CMDID) || |
| (cmd_id == WMI_OFFCHAN_DATA_TX_SEND_CMDID)) { |
| return true; |
| } |
| |
| return false; |
| } |
| |
| static uint16_t wmi_tag_vdev_set_cmd(wmi_unified_t wmi_hdl, wmi_buf_t buf) |
| { |
| wmi_vdev_set_param_cmd_fixed_param *set_cmd; |
| |
| set_cmd = (wmi_vdev_set_param_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| switch (set_cmd->param_id) { |
| case WMI_VDEV_PARAM_LISTEN_INTERVAL: |
| case WMI_VDEV_PARAM_DTIM_POLICY: |
| return HTC_TX_PACKET_TAG_AUTO_PM; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static uint16_t wmi_tag_sta_powersave_cmd(wmi_unified_t wmi_hdl, wmi_buf_t buf) |
| { |
| wmi_sta_powersave_param_cmd_fixed_param *ps_cmd; |
| |
| ps_cmd = (wmi_sta_powersave_param_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| switch (ps_cmd->param) { |
| case WMI_STA_PS_PARAM_TX_WAKE_THRESHOLD: |
| case WMI_STA_PS_PARAM_INACTIVITY_TIME: |
| case WMI_STA_PS_ENABLE_QPOWER: |
| return HTC_TX_PACKET_TAG_AUTO_PM; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static uint16_t wmi_tag_common_cmd(wmi_unified_t wmi_hdl, wmi_buf_t buf, |
| uint32_t cmd_id) |
| { |
| if (qdf_atomic_read(&wmi_hdl->is_wow_bus_suspended)) |
| return 0; |
| |
| switch (cmd_id) { |
| case WMI_VDEV_SET_PARAM_CMDID: |
| return wmi_tag_vdev_set_cmd(wmi_hdl, buf); |
| case WMI_STA_POWERSAVE_PARAM_CMDID: |
| return wmi_tag_sta_powersave_cmd(wmi_hdl, buf); |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static uint16_t wmi_tag_fw_hang_cmd(wmi_unified_t wmi_handle) |
| { |
| uint16_t tag = 0; |
| |
| if (qdf_atomic_read(&wmi_handle->is_target_suspended)) { |
| pr_err("%s: Target is already suspended, Ignore FW Hang Command\n", |
| __func__); |
| return tag; |
| } |
| |
| if (wmi_handle->tag_crash_inject) |
| tag = HTC_TX_PACKET_TAG_AUTO_PM; |
| |
| wmi_handle->tag_crash_inject = false; |
| return tag; |
| } |
| |
| /** |
| * wmi_set_htc_tx_tag_tlv() - set HTC TX tag for WMI commands |
| * @wmi_handle: WMI handle |
| * @buf: WMI buffer |
| * @cmd_id: WMI command Id |
| * |
| * Return htc_tx_tag |
| */ |
| static uint16_t wmi_set_htc_tx_tag_tlv(wmi_unified_t wmi_handle, |
| wmi_buf_t buf, |
| uint32_t cmd_id) |
| { |
| uint16_t htc_tx_tag = 0; |
| |
| switch (cmd_id) { |
| case WMI_WOW_ENABLE_CMDID: |
| case WMI_PDEV_SUSPEND_CMDID: |
| case WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID: |
| case WMI_WOW_ADD_WAKE_PATTERN_CMDID: |
| case WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID: |
| case WMI_PDEV_RESUME_CMDID: |
| case WMI_WOW_DEL_WAKE_PATTERN_CMDID: |
| case WMI_WOW_SET_ACTION_WAKE_UP_CMDID: |
| #ifdef FEATURE_WLAN_D0WOW |
| case WMI_D0_WOW_ENABLE_DISABLE_CMDID: |
| #endif |
| htc_tx_tag = HTC_TX_PACKET_TAG_AUTO_PM; |
| break; |
| case WMI_FORCE_FW_HANG_CMDID: |
| htc_tx_tag = wmi_tag_fw_hang_cmd(wmi_handle); |
| break; |
| case WMI_VDEV_SET_PARAM_CMDID: |
| case WMI_STA_POWERSAVE_PARAM_CMDID: |
| htc_tx_tag = wmi_tag_common_cmd(wmi_handle, buf, cmd_id); |
| default: |
| break; |
| } |
| |
| return htc_tx_tag; |
| } |
| |
| /** |
| * 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( |
| event->pdev_id); |
| |
| 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( |
| 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]\n", |
| 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(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; |
| } |
| |
| static struct cur_reg_rule |
| *create_reg_rules_from_wmi(uint32_t num_reg_rules, |
| wmi_regulatory_rule_struct *wmi_reg_rule) |
| { |
| struct cur_reg_rule *reg_rule_ptr; |
| uint32_t count; |
| |
| reg_rule_ptr = qdf_mem_malloc(num_reg_rules * sizeof(*reg_rule_ptr)); |
| |
| if (NULL == reg_rule_ptr) { |
| WMI_LOGE("memory allocation failure"); |
| return NULL; |
| } |
| |
| for (count = 0; count < num_reg_rules; count++) { |
| reg_rule_ptr[count].start_freq = |
| WMI_REG_RULE_START_FREQ_GET( |
| wmi_reg_rule[count].freq_info); |
| reg_rule_ptr[count].end_freq = |
| WMI_REG_RULE_END_FREQ_GET( |
| wmi_reg_rule[count].freq_info); |
| reg_rule_ptr[count].max_bw = |
| WMI_REG_RULE_MAX_BW_GET( |
| wmi_reg_rule[count].bw_pwr_info); |
| reg_rule_ptr[count].reg_power = |
| WMI_REG_RULE_REG_POWER_GET( |
| wmi_reg_rule[count].bw_pwr_info); |
| reg_rule_ptr[count].ant_gain = |
| WMI_REG_RULE_ANTENNA_GAIN_GET( |
| wmi_reg_rule[count].bw_pwr_info); |
| reg_rule_ptr[count].flags = |
| WMI_REG_RULE_FLAGS_GET( |
| wmi_reg_rule[count].flag_info); |
| } |
| |
| return reg_rule_ptr; |
| } |
| |
| static QDF_STATUS extract_reg_chan_list_update_event_tlv( |
| wmi_unified_t wmi_handle, uint8_t *evt_buf, |
| struct cur_regulatory_info *reg_info, uint32_t len) |
| { |
| WMI_REG_CHAN_LIST_CC_EVENTID_param_tlvs *param_buf; |
| wmi_reg_chan_list_cc_event_fixed_param *chan_list_event_hdr; |
| wmi_regulatory_rule_struct *wmi_reg_rule; |
| uint32_t num_2g_reg_rules, num_5g_reg_rules; |
| |
| WMI_LOGD("processing regulatory channel list"); |
| |
| param_buf = (WMI_REG_CHAN_LIST_CC_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("invalid channel list event buf"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| chan_list_event_hdr = param_buf->fixed_param; |
| |
| reg_info->num_2g_reg_rules = chan_list_event_hdr->num_2g_reg_rules; |
| reg_info->num_5g_reg_rules = chan_list_event_hdr->num_5g_reg_rules; |
| qdf_mem_copy(reg_info->alpha2, &(chan_list_event_hdr->alpha2), |
| REG_ALPHA2_LEN); |
| reg_info->dfs_region = chan_list_event_hdr->dfs_region; |
| reg_info->phybitmap = chan_list_event_hdr->phybitmap; |
| reg_info->offload_enabled = true; |
| reg_info->num_phy = chan_list_event_hdr->num_phy; |
| reg_info->phy_id = chan_list_event_hdr->phy_id; |
| reg_info->ctry_code = chan_list_event_hdr->country_id; |
| reg_info->reg_dmn_pair = chan_list_event_hdr->domain_code; |
| if (chan_list_event_hdr->status_code == WMI_REG_SET_CC_STATUS_PASS) |
| reg_info->status_code = REG_SET_CC_STATUS_PASS; |
| else if (chan_list_event_hdr->status_code == |
| WMI_REG_CURRENT_ALPHA2_NOT_FOUND) |
| reg_info->status_code = REG_CURRENT_ALPHA2_NOT_FOUND; |
| else if (chan_list_event_hdr->status_code == |
| WMI_REG_INIT_ALPHA2_NOT_FOUND) |
| reg_info->status_code = REG_INIT_ALPHA2_NOT_FOUND; |
| else if (chan_list_event_hdr->status_code == |
| WMI_REG_SET_CC_CHANGE_NOT_ALLOWED) |
| reg_info->status_code = REG_SET_CC_CHANGE_NOT_ALLOWED; |
| else if (chan_list_event_hdr->status_code == |
| WMI_REG_SET_CC_STATUS_NO_MEMORY) |
| reg_info->status_code = REG_SET_CC_STATUS_NO_MEMORY; |
| else if (chan_list_event_hdr->status_code == |
| WMI_REG_SET_CC_STATUS_FAIL) |
| reg_info->status_code = REG_SET_CC_STATUS_FAIL; |
| |
| reg_info->min_bw_2g = chan_list_event_hdr->min_bw_2g; |
| reg_info->max_bw_2g = chan_list_event_hdr->max_bw_2g; |
| reg_info->min_bw_5g = chan_list_event_hdr->min_bw_5g; |
| reg_info->max_bw_5g = chan_list_event_hdr->max_bw_5g; |
| |
| num_2g_reg_rules = reg_info->num_2g_reg_rules; |
| num_5g_reg_rules = reg_info->num_5g_reg_rules; |
| |
| WMI_LOGD("%s:cc %s dsf %d BW: min_2g %d max_2g %d min_5g %d max_5g %d", |
| __func__, reg_info->alpha2, reg_info->dfs_region, |
| reg_info->min_bw_2g, reg_info->max_bw_2g, |
| reg_info->min_bw_5g, reg_info->max_bw_5g); |
| |
| WMI_LOGD("%s: num_2g_reg_rules %d num_5g_reg_rules %d", __func__, |
| num_2g_reg_rules, num_5g_reg_rules); |
| wmi_reg_rule = |
| (wmi_regulatory_rule_struct *)((uint8_t *)chan_list_event_hdr |
| + sizeof(wmi_reg_chan_list_cc_event_fixed_param) |
| + WMI_TLV_HDR_SIZE); |
| reg_info->reg_rules_2g_ptr = create_reg_rules_from_wmi(num_2g_reg_rules, |
| wmi_reg_rule); |
| wmi_reg_rule += num_2g_reg_rules; |
| |
| reg_info->reg_rules_5g_ptr = create_reg_rules_from_wmi(num_5g_reg_rules, |
| wmi_reg_rule); |
| |
| WMI_LOGD("processed regulatory channel list"); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_reg_11d_new_country_event_tlv( |
| wmi_unified_t wmi_handle, uint8_t *evt_buf, |
| struct reg_11d_new_country *reg_11d_country, uint32_t len) |
| { |
| wmi_11d_new_country_event_fixed_param *reg_11d_country_event; |
| WMI_11D_NEW_COUNTRY_EVENTID_param_tlvs *param_buf; |
| |
| param_buf = (WMI_11D_NEW_COUNTRY_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("invalid 11d country event buf"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| reg_11d_country_event = param_buf->fixed_param; |
| |
| qdf_mem_copy(reg_11d_country->alpha2, |
| ®_11d_country_event->new_alpha2, REG_ALPHA2_LEN); |
| |
| WMI_LOGD("processed 11d country event, new cc %s", |
| reg_11d_country->alpha2); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| static QDF_STATUS extract_reg_ch_avoid_event_tlv( |
| wmi_unified_t wmi_handle, uint8_t *evt_buf, |
| struct ch_avoid_ind_type *ch_avoid_ind, uint32_t len) |
| { |
| wmi_avoid_freq_ranges_event_fixed_param *afr_fixed_param; |
| wmi_avoid_freq_range_desc *afr_desc; |
| uint32_t num_freq_ranges, freq_range_idx; |
| WMI_WLAN_FREQ_AVOID_EVENTID_param_tlvs *param_buf = |
| (WMI_WLAN_FREQ_AVOID_EVENTID_param_tlvs *) evt_buf; |
| |
| if (!param_buf) { |
| WMI_LOGE("Invalid channel avoid event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| afr_fixed_param = param_buf->fixed_param; |
| if (!afr_fixed_param) { |
| WMI_LOGE("Invalid channel avoid event fixed param buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| if (!ch_avoid_ind) { |
| WMI_LOGE("Invalid channel avoid indication buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| num_freq_ranges = (afr_fixed_param->num_freq_ranges > |
| CH_AVOID_MAX_RANGE) ? CH_AVOID_MAX_RANGE : |
| afr_fixed_param->num_freq_ranges; |
| |
| WMI_LOGD("Channel avoid event received with %d ranges", |
| num_freq_ranges); |
| |
| ch_avoid_ind->ch_avoid_range_cnt = num_freq_ranges; |
| afr_desc = (wmi_avoid_freq_range_desc *)(param_buf->avd_freq_range); |
| for (freq_range_idx = 0; freq_range_idx < num_freq_ranges; |
| freq_range_idx++) { |
| ch_avoid_ind->avoid_freq_range[freq_range_idx].start_freq = |
| afr_desc->start_freq; |
| ch_avoid_ind->avoid_freq_range[freq_range_idx].end_freq = |
| afr_desc->end_freq; |
| WMI_LOGD("range %d tlv id %u, start freq %u, end freq %u", |
| freq_range_idx, afr_desc->tlv_header, |
| afr_desc->start_freq, afr_desc->end_freq); |
| afr_desc++; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #ifdef DFS_COMPONENT_ENABLE |
| /** |
| * extract_dfs_cac_complete_event_tlv() - extract cac complete event |
| * @wmi_handle: wma handle |
| * @evt_buf: event buffer |
| * @vdev_id: vdev id |
| * @len: length of buffer |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS extract_dfs_cac_complete_event_tlv(wmi_unified_t wmi_handle, |
| uint8_t *evt_buf, |
| uint32_t *vdev_id, |
| uint32_t len) |
| { |
| WMI_VDEV_DFS_CAC_COMPLETE_EVENTID_param_tlvs *param_tlvs; |
| wmi_vdev_dfs_cac_complete_event_fixed_param *cac_event; |
| |
| param_tlvs = (WMI_VDEV_DFS_CAC_COMPLETE_EVENTID_param_tlvs *) evt_buf; |
| if (!param_tlvs) { |
| WMI_LOGE("invalid cac complete event buf"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cac_event = param_tlvs->fixed_param; |
| *vdev_id = cac_event->vdev_id; |
| WMI_LOGD("processed cac complete event vdev %d", *vdev_id); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_dfs_radar_detection_event_tlv() - extract radar found event |
| * @wmi_handle: wma handle |
| * @evt_buf: event buffer |
| * @radar_found: radar found event info |
| * @len: length of buffer |
| * |
| * Return: 0 for success or error code |
| */ |
| static QDF_STATUS extract_dfs_radar_detection_event_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *evt_buf, |
| struct radar_found_info *radar_found, |
| uint32_t len) |
| { |
| WMI_PDEV_DFS_RADAR_DETECTION_EVENTID_param_tlvs *param_tlv; |
| wmi_pdev_dfs_radar_detection_event_fixed_param *radar_event; |
| |
| param_tlv = (WMI_PDEV_DFS_RADAR_DETECTION_EVENTID_param_tlvs *) evt_buf; |
| if (!param_tlv) { |
| WMI_LOGE("invalid radar detection event buf"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| radar_event = param_tlv->fixed_param; |
| radar_found->pdev_id = convert_target_pdev_id_to_host_pdev_id( |
| radar_event->pdev_id); |
| radar_found->detection_mode = radar_event->detection_mode; |
| radar_found->chan_freq = radar_event->chan_freq; |
| radar_found->chan_width = radar_event->chan_width; |
| radar_found->detector_id = radar_event->detector_id; |
| radar_found->segment_id = radar_event->segment_id; |
| radar_found->timestamp = radar_event->timestamp; |
| radar_found->is_chirp = radar_event->is_chirp; |
| radar_found->freq_offset = radar_event->freq_offset; |
| radar_found->sidx = radar_event->sidx; |
| |
| WMI_LOGI("processed radar found event pdev %d," |
| "Radar Event Info:pdev_id %d,timestamp %d,chan_freq (dur) %d," |
| "chan_width (RSSI) %d,detector_id (false_radar) %d," |
| "freq_offset (radar_check) %d,segment_id %d,sidx %d," |
| "is_chirp %d,detection mode %d\n", |
| radar_event->pdev_id, radar_found->pdev_id, |
| radar_event->timestamp, radar_event->chan_freq, |
| radar_event->chan_width, radar_event->detector_id, |
| radar_event->freq_offset, radar_event->segment_id, |
| radar_event->sidx, radar_event->is_chirp, |
| radar_event->detection_mode); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| #ifdef QCA_MCL_DFS_SUPPORT |
| /** |
| * extract_wlan_radar_event_info_tlv() - extract radar pulse event |
| * @wmi_handle: wma handle |
| * @evt_buf: event buffer |
| * @wlan_radar_event: Pointer to struct radar_event_info |
| * @len: length of buffer |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS extract_wlan_radar_event_info_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *evt_buf, |
| struct radar_event_info *wlan_radar_event, |
| uint32_t len) |
| { |
| WMI_DFS_RADAR_EVENTID_param_tlvs *param_tlv; |
| wmi_dfs_radar_event_fixed_param *radar_event; |
| |
| param_tlv = (WMI_DFS_RADAR_EVENTID_param_tlvs *)evt_buf; |
| if (!param_tlv) { |
| WMI_LOGE("invalid wlan radar event buf"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| radar_event = param_tlv->fixed_param; |
| wlan_radar_event->pulse_is_chirp = radar_event->pulse_is_chirp; |
| wlan_radar_event->pulse_center_freq = radar_event->pulse_center_freq; |
| wlan_radar_event->pulse_duration = radar_event->pulse_duration; |
| wlan_radar_event->rssi = radar_event->rssi; |
| wlan_radar_event->pulse_detect_ts = radar_event->pulse_detect_ts; |
| wlan_radar_event->upload_fullts_high = radar_event->upload_fullts_high; |
| wlan_radar_event->upload_fullts_low = radar_event->upload_fullts_low; |
| wlan_radar_event->peak_sidx = radar_event->peak_sidx; |
| wlan_radar_event->delta_peak = radar_event->pulse_delta_peak; |
| wlan_radar_event->delta_diff = radar_event->pulse_delta_diff; |
| if (radar_event->pulse_flags & |
| WMI_DFS_RADAR_PULSE_FLAG_MASK_PSIDX_DIFF_VALID) { |
| wlan_radar_event->is_psidx_diff_valid = true; |
| wlan_radar_event->psidx_diff = radar_event->psidx_diff; |
| } else { |
| wlan_radar_event->is_psidx_diff_valid = false; |
| } |
| |
| wlan_radar_event->pdev_id = radar_event->pdev_id; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #else |
| static QDF_STATUS extract_wlan_radar_event_info_tlv( |
| wmi_unified_t wmi_handle, |
| uint8_t *evt_buf, |
| struct radar_event_info *wlan_radar_event, |
| uint32_t len) |
| { |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| #endif |
| |
| /** |
| * send_get_rcpi_cmd_tlv() - send request for rcpi value |
| * @wmi_handle: wmi handle |
| * @get_rcpi_param: rcpi params |
| * |
| * Return: QDF status |
| */ |
| static QDF_STATUS send_get_rcpi_cmd_tlv(wmi_unified_t wmi_handle, |
| struct rcpi_req *get_rcpi_param) |
| { |
| wmi_buf_t buf; |
| wmi_request_rcpi_cmd_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_request_rcpi_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed to allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_request_rcpi_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_request_rcpi_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_request_rcpi_cmd_fixed_param)); |
| |
| cmd->vdev_id = get_rcpi_param->vdev_id; |
| WMI_CHAR_ARRAY_TO_MAC_ADDR(get_rcpi_param->mac_addr, |
| &cmd->peer_macaddr); |
| |
| switch (get_rcpi_param->measurement_type) { |
| |
| case RCPI_MEASUREMENT_TYPE_AVG_MGMT: |
| cmd->measurement_type = WMI_RCPI_MEASUREMENT_TYPE_AVG_MGMT; |
| break; |
| |
| case RCPI_MEASUREMENT_TYPE_AVG_DATA: |
| cmd->measurement_type = WMI_RCPI_MEASUREMENT_TYPE_AVG_DATA; |
| break; |
| |
| case RCPI_MEASUREMENT_TYPE_LAST_MGMT: |
| cmd->measurement_type = WMI_RCPI_MEASUREMENT_TYPE_LAST_MGMT; |
| break; |
| |
| case RCPI_MEASUREMENT_TYPE_LAST_DATA: |
| cmd->measurement_type = WMI_RCPI_MEASUREMENT_TYPE_LAST_DATA; |
| break; |
| |
| default: |
| /* |
| * invalid rcpi measurement type, fall back to |
| * RCPI_MEASUREMENT_TYPE_AVG_MGMT |
| */ |
| cmd->measurement_type = WMI_RCPI_MEASUREMENT_TYPE_AVG_MGMT; |
| break; |
| } |
| WMI_LOGD("RCPI REQ VDEV_ID:%d-->", cmd->vdev_id); |
| wmi_mtrace(WMI_REQUEST_RCPI_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_RCPI_CMDID)) { |
| |
| WMI_LOGE("%s: Failed to send WMI_REQUEST_RCPI_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_rcpi_response_event_tlv() - Extract RCPI event params |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @res: pointer to hold rcpi response from firmware |
| * |
| * Return: QDF_STATUS_SUCCESS for successful event parse |
| * else QDF_STATUS_E_INVAL or QDF_STATUS_E_FAILURE |
| */ |
| static QDF_STATUS |
| extract_rcpi_response_event_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, struct rcpi_res *res) |
| { |
| WMI_UPDATE_RCPI_EVENTID_param_tlvs *param_buf; |
| wmi_update_rcpi_event_fixed_param *event; |
| |
| param_buf = (WMI_UPDATE_RCPI_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE(FL("Invalid rcpi event")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| event = param_buf->fixed_param; |
| res->vdev_id = event->vdev_id; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&event->peer_macaddr, res->mac_addr); |
| |
| switch (event->measurement_type) { |
| |
| case WMI_RCPI_MEASUREMENT_TYPE_AVG_MGMT: |
| res->measurement_type = RCPI_MEASUREMENT_TYPE_AVG_MGMT; |
| break; |
| |
| case WMI_RCPI_MEASUREMENT_TYPE_AVG_DATA: |
| res->measurement_type = RCPI_MEASUREMENT_TYPE_AVG_DATA; |
| break; |
| |
| case WMI_RCPI_MEASUREMENT_TYPE_LAST_MGMT: |
| res->measurement_type = RCPI_MEASUREMENT_TYPE_LAST_MGMT; |
| break; |
| |
| case WMI_RCPI_MEASUREMENT_TYPE_LAST_DATA: |
| res->measurement_type = RCPI_MEASUREMENT_TYPE_LAST_DATA; |
| break; |
| |
| default: |
| WMI_LOGE(FL("Invalid rcpi measurement type from firmware")); |
| res->measurement_type = RCPI_MEASUREMENT_TYPE_INVALID; |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (event->status) |
| return QDF_STATUS_E_FAILURE; |
| else |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * convert_host_pdev_id_to_target_pdev_id_legacy() - Convert pdev_id from |
| * host to target defines. For legacy there is not conversion |
| * required. Just return pdev_id as it is. |
| * @param pdev_id: host pdev_id to be converted. |
| * Return: target pdev_id after conversion. |
| */ |
| static uint32_t convert_host_pdev_id_to_target_pdev_id_legacy( |
| uint32_t pdev_id) |
| { |
| if (pdev_id == WMI_HOST_PDEV_ID_SOC) |
| return WMI_PDEV_ID_SOC; |
| |
| /*No conversion required*/ |
| return pdev_id; |
| } |
| |
| /** |
| * convert_target_pdev_id_to_host_pdev_id_legacy() - Convert pdev_id from |
| * target to host defines. For legacy there is not conversion |
| * required. Just return pdev_id as it is. |
| * @param pdev_id: target pdev_id to be converted. |
| * Return: host pdev_id after conversion. |
| */ |
| static uint32_t convert_target_pdev_id_to_host_pdev_id_legacy( |
| uint32_t pdev_id) |
| { |
| /*No conversion required*/ |
| return pdev_id; |
| } |
| |
| /** |
| * send_set_country_cmd_tlv() - WMI scan channel list function |
| * @param wmi_handle : handle to WMI. |
| * @param param : pointer to hold scan channel list parameter |
| * |
| * Return: 0 on success and -ve on failure. |
| */ |
| static QDF_STATUS send_set_country_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_country *params) |
| { |
| wmi_buf_t buf; |
| QDF_STATUS qdf_status; |
| wmi_set_current_country_cmd_fixed_param *cmd; |
| uint16_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("Failed to allocate memory"); |
| qdf_status = QDF_STATUS_E_NOMEM; |
| goto end; |
| } |
| |
| cmd = (wmi_set_current_country_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_set_current_country_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_set_current_country_cmd_fixed_param)); |
| |
| WMI_LOGD("setting cuurnet country to %s", params->country); |
| |
| qdf_mem_copy((uint8_t *)&cmd->new_alpha2, params->country, 3); |
| |
| cmd->pdev_id = params->pdev_id; |
| |
| wmi_mtrace(WMI_SET_CURRENT_COUNTRY_CMDID, NO_SESSION, 0); |
| qdf_status = wmi_unified_cmd_send(wmi_handle, |
| buf, len, WMI_SET_CURRENT_COUNTRY_CMDID); |
| |
| if (QDF_IS_STATUS_ERROR(qdf_status)) { |
| WMI_LOGE("Failed to send WMI_SET_CURRENT_COUNTRY_CMDID"); |
| wmi_buf_free(buf); |
| } |
| |
| end: |
| return qdf_status; |
| } |
| |
| #define WMI_REG_COUNTRY_ALPHA_SET(alpha, val0, val1, val2) do { \ |
| WMI_SET_BITS(alpha, 0, 8, val0); \ |
| WMI_SET_BITS(alpha, 8, 8, val1); \ |
| WMI_SET_BITS(alpha, 16, 8, val2); \ |
| } while (0) |
| |
| static QDF_STATUS send_user_country_code_cmd_tlv(wmi_unified_t wmi_handle, |
| uint8_t pdev_id, struct cc_regdmn_s *rd) |
| { |
| wmi_set_init_country_cmd_fixed_param *cmd; |
| uint16_t len; |
| wmi_buf_t buf; |
| int ret; |
| |
| len = sizeof(wmi_set_init_country_cmd_fixed_param); |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| cmd = (wmi_set_init_country_cmd_fixed_param *) wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_set_init_country_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_set_init_country_cmd_fixed_param)); |
| |
| cmd->pdev_id = wmi_handle->ops->convert_pdev_id_host_to_target(pdev_id); |
| |
| if (rd->flags == CC_IS_SET) { |
| cmd->countrycode_type = WMI_COUNTRYCODE_COUNTRY_ID; |
| cmd->country_code.country_id = rd->cc.country_code; |
| } else if (rd->flags == ALPHA_IS_SET) { |
| cmd->countrycode_type = WMI_COUNTRYCODE_ALPHA2; |
| WMI_REG_COUNTRY_ALPHA_SET(cmd->country_code.alpha2, |
| rd->cc.alpha[0], |
| rd->cc.alpha[1], |
| rd->cc.alpha[2]); |
| } else if (rd->flags == REGDMN_IS_SET) { |
| cmd->countrycode_type = WMI_COUNTRYCODE_DOMAIN_CODE; |
| cmd->country_code.domain_code = rd->cc.regdmn_id; |
| } |
| |
| wmi_mtrace(WMI_SET_INIT_COUNTRY_CMDID, NO_SESSION, 0); |
| ret = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_SET_INIT_COUNTRY_CMDID); |
| if (ret) { |
| WMI_LOGE("Failed to config wow wakeup event"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_limit_off_chan_cmd_tlv() - send wmi cmd of limit off chan |
| * configuration params |
| * @wmi_handle: wmi handler |
| * @limit_off_chan_param: pointer to wmi_off_chan_param |
| * |
| * Return: 0 for success and non zero for failure |
| */ |
| static |
| QDF_STATUS send_limit_off_chan_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_limit_off_chan_param *limit_off_chan_param) |
| { |
| wmi_vdev_limit_offchan_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| uint32_t len = sizeof(*cmd); |
| int err; |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: failed to allocate memory for limit off chan cmd", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_vdev_limit_offchan_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_limit_offchan_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_limit_offchan_cmd_fixed_param)); |
| |
| cmd->vdev_id = limit_off_chan_param->vdev_id; |
| |
| cmd->flags &= 0; |
| if (limit_off_chan_param->status) |
| cmd->flags |= WMI_VDEV_LIMIT_OFFCHAN_ENABLE; |
| if (limit_off_chan_param->skip_dfs_chans) |
| cmd->flags |= WMI_VDEV_LIMIT_OFFCHAN_SKIP_DFS; |
| |
| cmd->max_offchan_time = limit_off_chan_param->max_offchan_time; |
| cmd->rest_time = limit_off_chan_param->rest_time; |
| |
| WMI_LOGE("%s: vdev_id=%d, flags =%x, max_offchan_time=%d, rest_time=%d", |
| __func__, cmd->vdev_id, cmd->flags, cmd->max_offchan_time, |
| cmd->rest_time); |
| |
| wmi_mtrace(WMI_VDEV_LIMIT_OFFCHAN_CMDID, cmd->vdev_id, 0); |
| err = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_VDEV_LIMIT_OFFCHAN_CMDID); |
| if (QDF_IS_STATUS_ERROR(err)) { |
| WMI_LOGE("Failed to send limit off chan cmd err=%d", err); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_set_arp_stats_req_cmd_tlv() - send wmi cmd to set arp stats request |
| * @wmi_handle: wmi handler |
| * @req_buf: set arp stats request buffer |
| * |
| * Return: 0 for success and non zero for failure |
| */ |
| static QDF_STATUS send_set_arp_stats_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct set_arp_stats *req_buf) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_vdev_set_arp_stats_cmd_fixed_param *wmi_set_arp; |
| |
| len = sizeof(wmi_vdev_set_arp_stats_cmd_fixed_param); |
| if (req_buf->pkt_type_bitmap) { |
| len += WMI_TLV_HDR_SIZE; |
| len += sizeof(wmi_vdev_set_connectivity_check_stats); |
| } |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s : wmi_buf_alloc failed", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| wmi_set_arp = |
| (wmi_vdev_set_arp_stats_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&wmi_set_arp->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_arp_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_set_arp_stats_cmd_fixed_param)); |
| |
| /* fill in per roam config values */ |
| wmi_set_arp->vdev_id = req_buf->vdev_id; |
| |
| wmi_set_arp->set_clr = req_buf->flag; |
| wmi_set_arp->pkt_type = req_buf->pkt_type; |
| wmi_set_arp->ipv4 = req_buf->ip_addr; |
| |
| WMI_LOGD("NUD Stats: vdev_id %u set_clr %u pkt_type:%u ipv4 %u", |
| wmi_set_arp->vdev_id, wmi_set_arp->set_clr, |
| wmi_set_arp->pkt_type, wmi_set_arp->ipv4); |
| |
| /* |
| * pkt_type_bitmap should be non-zero to ensure |
| * presence of additional stats. |
| */ |
| if (req_buf->pkt_type_bitmap) { |
| wmi_vdev_set_connectivity_check_stats *wmi_set_connect_stats; |
| |
| buf_ptr += sizeof(wmi_vdev_set_arp_stats_cmd_fixed_param); |
| WMITLV_SET_HDR(buf_ptr, |
| WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_vdev_set_connectivity_check_stats)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| wmi_set_connect_stats = |
| (wmi_vdev_set_connectivity_check_stats *)buf_ptr; |
| WMITLV_SET_HDR(&wmi_set_connect_stats->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_set_connectivity_check_stats, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_vdev_set_connectivity_check_stats)); |
| wmi_set_connect_stats->pkt_type_bitmap = |
| req_buf->pkt_type_bitmap; |
| wmi_set_connect_stats->tcp_src_port = req_buf->tcp_src_port; |
| wmi_set_connect_stats->tcp_dst_port = req_buf->tcp_dst_port; |
| wmi_set_connect_stats->icmp_ipv4 = req_buf->icmp_ipv4; |
| |
| WMI_LOGD("Connectivity Stats: pkt_type_bitmap %u tcp_src_port:%u tcp_dst_port %u icmp_ipv4 %u", |
| wmi_set_connect_stats->pkt_type_bitmap, |
| wmi_set_connect_stats->tcp_src_port, |
| wmi_set_connect_stats->tcp_dst_port, |
| wmi_set_connect_stats->icmp_ipv4); |
| } |
| |
| /* Send per roam config parameters */ |
| wmi_mtrace(WMI_VDEV_SET_ARP_STAT_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_VDEV_SET_ARP_STAT_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_SET_ARP_STATS_CMDID failed, Error %d", |
| status); |
| goto error; |
| } |
| |
| WMI_LOGD(FL("set arp stats flag=%d, vdev=%d"), |
| req_buf->flag, req_buf->vdev_id); |
| return QDF_STATUS_SUCCESS; |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_get_arp_stats_req_cmd_tlv() - send wmi cmd to get arp stats request |
| * @wmi_handle: wmi handler |
| * @req_buf: get arp stats request buffer |
| * |
| * Return: 0 for success and non zero for failure |
| */ |
| static QDF_STATUS send_get_arp_stats_req_cmd_tlv(wmi_unified_t wmi_handle, |
| struct get_arp_stats *req_buf) |
| { |
| wmi_buf_t buf = NULL; |
| QDF_STATUS status; |
| int len; |
| uint8_t *buf_ptr; |
| wmi_vdev_get_arp_stats_cmd_fixed_param *get_arp_stats; |
| |
| len = sizeof(wmi_vdev_get_arp_stats_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; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| get_arp_stats = |
| (wmi_vdev_get_arp_stats_cmd_fixed_param *) buf_ptr; |
| WMITLV_SET_HDR(&get_arp_stats->tlv_header, |
| WMITLV_TAG_STRUC_wmi_vdev_get_arp_stats_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_vdev_get_arp_stats_cmd_fixed_param)); |
| |
| /* fill in arp stats req cmd values */ |
| get_arp_stats->vdev_id = req_buf->vdev_id; |
| |
| WMI_LOGI(FL("vdev=%d"), req_buf->vdev_id); |
| /* Send per roam config parameters */ |
| wmi_mtrace(WMI_VDEV_GET_ARP_STAT_CMDID, NO_SESSION, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, |
| len, WMI_VDEV_GET_ARP_STAT_CMDID); |
| if (QDF_IS_STATUS_ERROR(status)) { |
| WMI_LOGE("WMI_GET_ARP_STATS_CMDID failed, Error %d", |
| status); |
| goto error; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| error: |
| wmi_buf_free(buf); |
| |
| return status; |
| } |
| |
| /** |
| * send_set_del_pmkid_cache_cmd_tlv() - send wmi cmd of set del pmkid |
| * @wmi_handle: wmi handler |
| * @pmk_info: pointer to PMK cache entry |
| * @vdev_id: vdev id |
| * |
| * Return: 0 for success and non zero for failure |
| */ |
| static QDF_STATUS send_set_del_pmkid_cache_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_unified_pmk_cache *pmk_info) |
| { |
| wmi_pdev_update_pmk_cache_cmd_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| uint8_t *buf_ptr; |
| wmi_pmk_cache *pmksa; |
| uint32_t len = sizeof(*cmd); |
| |
| if (pmk_info->pmk_len) |
| len += WMI_TLV_HDR_SIZE + sizeof(*pmksa); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: failed to allocate memory for set del pmkid cache", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_pdev_update_pmk_cache_cmd_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_pdev_update_pmk_cache_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_pdev_update_pmk_cache_cmd_fixed_param)); |
| |
| cmd->vdev_id = pmk_info->session_id; |
| |
| /* If pmk_info->pmk_len is 0, this is a flush request */ |
| if (!pmk_info->pmk_len) { |
| cmd->op_flag = WMI_PMK_CACHE_OP_FLAG_FLUSH_ALL; |
| cmd->num_cache = 0; |
| goto send_cmd; |
| } |
| |
| cmd->num_cache = 1; |
| buf_ptr += sizeof(*cmd); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(*pmksa)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| pmksa = (wmi_pmk_cache *)buf_ptr; |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_STRUC_wmi_pmk_cache, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_pmk_cache)); |
| pmksa->pmk_len = pmk_info->pmk_len; |
| qdf_mem_copy(pmksa->pmk, pmk_info->pmk, pmksa->pmk_len); |
| pmksa->pmkid_len = pmk_info->pmkid_len; |
| qdf_mem_copy(pmksa->pmkid, pmk_info->pmkid, pmksa->pmkid_len); |
| qdf_mem_copy(&(pmksa->bssid), &(pmk_info->bssid), sizeof(wmi_mac_addr)); |
| pmksa->ssid.ssid_len = pmk_info->ssid.length; |
| qdf_mem_copy(&(pmksa->ssid.ssid), &(pmk_info->ssid.mac_ssid), |
| pmksa->ssid.ssid_len); |
| pmksa->cache_id = pmk_info->cache_id; |
| pmksa->cat_flag = pmk_info->cat_flag; |
| pmksa->action_flag = pmk_info->action_flag; |
| |
| send_cmd: |
| wmi_mtrace(WMI_PDEV_UPDATE_PMK_CACHE_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_PDEV_UPDATE_PMK_CACHE_CMDID); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: failed to send set del pmkid cache command %d", |
| __func__, status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * 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; |
| } |
| |
| /* |
| * send_btm_config_cmd_tlv() - Send wmi cmd for BTM config |
| * @wmi_handle: wmi handle |
| * @params: pointer to wmi_btm_config |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS send_btm_config_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_btm_config *params) |
| { |
| |
| wmi_btm_config_fixed_param *cmd; |
| wmi_buf_t buf; |
| 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_NOMEM; |
| } |
| |
| cmd = (wmi_btm_config_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_btm_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN(wmi_btm_config_fixed_param)); |
| cmd->vdev_id = params->vdev_id; |
| cmd->flags = params->btm_offload_config; |
| cmd->max_attempt_cnt = params->btm_max_attempt_cnt; |
| cmd->solicited_timeout_ms = params->btm_solicited_timeout; |
| cmd->stick_time_seconds = params->btm_sticky_time; |
| |
| wmi_mtrace(WMI_ROAM_BTM_CONFIG_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_ROAM_BTM_CONFIG_CMDID)) { |
| WMI_LOGE("%s: failed to send WMI_ROAM_BTM_CONFIG_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_obss_detection_cfg_cmd_tlv() - send obss detection |
| * configurations to firmware. |
| * @wmi_handle: wmi handle |
| * @obss_cfg_param: obss detection configurations |
| * |
| * Send WMI_SAP_OBSS_DETECTION_CFG_CMDID parameters to fw. |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS send_obss_detection_cfg_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_obss_detection_cfg_param *obss_cfg_param) |
| { |
| wmi_buf_t buf; |
| wmi_sap_obss_detection_cfg_cmd_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_sap_obss_detection_cfg_cmd_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed to allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_sap_obss_detection_cfg_cmd_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_sap_obss_detection_cfg_cmd_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_sap_obss_detection_cfg_cmd_fixed_param)); |
| |
| cmd->vdev_id = obss_cfg_param->vdev_id; |
| cmd->detect_period_ms = obss_cfg_param->obss_detect_period_ms; |
| cmd->b_ap_detect_mode = obss_cfg_param->obss_11b_ap_detect_mode; |
| cmd->b_sta_detect_mode = obss_cfg_param->obss_11b_sta_detect_mode; |
| cmd->g_ap_detect_mode = obss_cfg_param->obss_11g_ap_detect_mode; |
| cmd->a_detect_mode = obss_cfg_param->obss_11a_detect_mode; |
| cmd->ht_legacy_detect_mode = obss_cfg_param->obss_ht_legacy_detect_mode; |
| cmd->ht_mixed_detect_mode = obss_cfg_param->obss_ht_mixed_detect_mode; |
| cmd->ht_20mhz_detect_mode = obss_cfg_param->obss_ht_20mhz_detect_mode; |
| |
| wmi_mtrace(WMI_SAP_OBSS_DETECTION_CFG_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_SAP_OBSS_DETECTION_CFG_CMDID)) { |
| WMI_LOGE("Failed to send WMI_SAP_OBSS_DETECTION_CFG_CMDID"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_obss_detection_info_tlv() - Extract obss detection info |
| * received from firmware. |
| * @evt_buf: pointer to event buffer |
| * @obss_detection: Pointer to hold obss detection info |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS extract_obss_detection_info_tlv(uint8_t *evt_buf, |
| struct wmi_obss_detect_info |
| *obss_detection) |
| { |
| WMI_SAP_OBSS_DETECTION_REPORT_EVENTID_param_tlvs *param_buf; |
| wmi_sap_obss_detection_info_evt_fixed_param *fix_param; |
| |
| if (!obss_detection) { |
| WMI_LOGE("%s: Invalid obss_detection event buffer", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| param_buf = (WMI_SAP_OBSS_DETECTION_REPORT_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("%s: Invalid evt_buf", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| fix_param = param_buf->fixed_param; |
| obss_detection->vdev_id = fix_param->vdev_id; |
| obss_detection->matched_detection_masks = |
| fix_param->matched_detection_masks; |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&fix_param->matched_bssid_addr, |
| &obss_detection->matched_bssid_addr[0]); |
| switch (fix_param->reason) { |
| case WMI_SAP_OBSS_DETECTION_EVENT_REASON_NOT_SUPPORT: |
| obss_detection->reason = OBSS_OFFLOAD_DETECTION_DISABLED; |
| break; |
| case WMI_SAP_OBSS_DETECTION_EVENT_REASON_PRESENT_NOTIFY: |
| obss_detection->reason = OBSS_OFFLOAD_DETECTION_PRESENT; |
| break; |
| case WMI_SAP_OBSS_DETECTION_EVENT_REASON_ABSENT_TIMEOUT: |
| obss_detection->reason = OBSS_OFFLOAD_DETECTION_ABSENT; |
| break; |
| default: |
| WMI_LOGE("%s: Invalid reason %d", __func__, fix_param->reason); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_roam_scan_stats_cmd_tlv() - Send roam scan stats req command to fw |
| * @wmi_handle: wmi handle |
| * @params: pointer to request structure |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS |
| send_roam_scan_stats_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_roam_scan_stats_req *params) |
| { |
| wmi_buf_t buf; |
| wmi_request_roam_scan_stats_cmd_fixed_param *cmd; |
| WMITLV_TAG_ID tag; |
| uint32_t size; |
| uint32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE(FL("Failed to allocate wmi buffer")); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| cmd = (wmi_request_roam_scan_stats_cmd_fixed_param *)wmi_buf_data(buf); |
| |
| tag = WMITLV_TAG_STRUC_wmi_request_roam_scan_stats_cmd_fixed_param; |
| size = WMITLV_GET_STRUCT_TLVLEN( |
| wmi_request_roam_scan_stats_cmd_fixed_param); |
| WMITLV_SET_HDR(&cmd->tlv_header, tag, size); |
| |
| cmd->vdev_id = params->vdev_id; |
| |
| WMI_LOGD(FL("Roam Scan Stats Req vdev_id: %u"), cmd->vdev_id); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_REQUEST_ROAM_SCAN_STATS_CMDID)) { |
| WMI_LOGE("%s: Failed to send WMI_REQUEST_ROAM_SCAN_STATS_CMDID", |
| __func__); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_roam_scan_stats_res_evt_tlv() - Extract roam scan stats event |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @vdev_id: output pointer to hold vdev id |
| * @res_param: output pointer to hold the allocated response |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS |
| extract_roam_scan_stats_res_evt_tlv(wmi_unified_t wmi_handle, void *evt_buf, |
| uint32_t *vdev_id, |
| struct wmi_roam_scan_stats_res **res_param) |
| { |
| WMI_ROAM_SCAN_STATS_EVENTID_param_tlvs *param_buf; |
| wmi_roam_scan_stats_event_fixed_param *fixed_param; |
| uint32_t *client_id = NULL; |
| wmi_roaming_timestamp *timestamp = NULL; |
| uint32_t *num_channels = NULL; |
| uint32_t *chan_info = NULL; |
| wmi_mac_addr *old_bssid = NULL; |
| uint32_t *is_roaming_success = NULL; |
| wmi_mac_addr *new_bssid = NULL; |
| uint32_t *num_roam_candidates = NULL; |
| wmi_roam_scan_trigger_reason *roam_reason = NULL; |
| wmi_mac_addr *bssid = NULL; |
| uint32_t *score = NULL; |
| uint32_t *channel = NULL; |
| uint32_t *rssi = NULL; |
| int chan_idx = 0, cand_idx = 0; |
| uint32_t total_len; |
| struct wmi_roam_scan_stats_res *res; |
| uint32_t i, j; |
| uint32_t num_scans; |
| |
| *res_param = NULL; |
| *vdev_id = 0xFF; /* Initialize to invalid vdev id */ |
| param_buf = (WMI_ROAM_SCAN_STATS_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE(FL("Invalid roam scan stats event")); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| fixed_param = param_buf->fixed_param; |
| total_len = sizeof(*res) + fixed_param->num_roam_scans * |
| sizeof(struct wmi_roam_scan_stats_params); |
| |
| *vdev_id = fixed_param->vdev_id; |
| num_scans = fixed_param->num_roam_scans; |
| |
| res = qdf_mem_malloc(total_len); |
| if (!res) { |
| WMI_LOGE("Failed to allocate roam scan stats response memory"); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| if (!num_scans) { |
| *res_param = res; |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| if (param_buf->client_id && |
| param_buf->num_client_id == num_scans) |
| client_id = param_buf->client_id; |
| |
| if (param_buf->timestamp && |
| param_buf->num_timestamp == num_scans) |
| timestamp = param_buf->timestamp; |
| |
| if (param_buf->old_bssid && |
| param_buf->num_old_bssid == num_scans) |
| old_bssid = param_buf->old_bssid; |
| |
| if (param_buf->new_bssid && |
| param_buf->num_new_bssid == num_scans) |
| new_bssid = param_buf->new_bssid; |
| |
| if (param_buf->is_roaming_success && |
| param_buf->num_is_roaming_success == num_scans) |
| is_roaming_success = param_buf->is_roaming_success; |
| |
| if (param_buf->roam_reason && |
| param_buf->num_roam_reason == num_scans) |
| roam_reason = param_buf->roam_reason; |
| |
| if (param_buf->num_channels && |
| param_buf->num_num_channels == num_scans) { |
| uint32_t count, chan_info_sum = 0; |
| |
| num_channels = param_buf->num_channels; |
| for (count = 0; count < param_buf->num_num_channels; count++) |
| chan_info_sum += param_buf->num_channels[count]; |
| |
| if (param_buf->chan_info && |
| param_buf->num_chan_info == chan_info_sum) |
| chan_info = param_buf->chan_info; |
| } |
| |
| if (param_buf->num_roam_candidates && |
| param_buf->num_num_roam_candidates == num_scans) { |
| uint32_t count, roam_cand_sum = 0; |
| |
| num_roam_candidates = param_buf->num_roam_candidates; |
| for (count = 0; count < param_buf->num_num_roam_candidates; |
| count++) |
| roam_cand_sum += param_buf->num_roam_candidates[count]; |
| |
| if (param_buf->bssid && |
| param_buf->num_bssid == roam_cand_sum) |
| bssid = param_buf->bssid; |
| |
| if (param_buf->score && |
| param_buf->num_score == roam_cand_sum) |
| score = param_buf->score; |
| |
| if (param_buf->channel && |
| param_buf->num_channel == roam_cand_sum) |
| channel = param_buf->channel; |
| |
| if (param_buf->rssi && |
| param_buf->num_rssi == roam_cand_sum) |
| rssi = param_buf->rssi; |
| } |
| |
| res->num_roam_scans = num_scans; |
| for (i = 0; i < num_scans; i++) { |
| struct wmi_roam_scan_stats_params *roam = &res->roam_scan[i]; |
| |
| if (timestamp) |
| roam->time_stamp = timestamp[i].lower32bit | |
| (timestamp[i].upper32bit << 31); |
| |
| if (client_id) |
| roam->client_id = client_id[i]; |
| |
| if (num_channels) { |
| roam->num_scan_chans = num_channels[i]; |
| if (chan_info) { |
| for (j = 0; j < num_channels[i]; j++) |
| roam->scan_freqs[j] = |
| chan_info[chan_idx++]; |
| } |
| } |
| |
| if (is_roaming_success) |
| roam->is_roam_successful = is_roaming_success[i]; |
| |
| if (roam_reason) { |
| roam->trigger_id = roam_reason[i].trigger_id; |
| roam->trigger_value = roam_reason[i].trigger_value; |
| } |
| |
| if (num_roam_candidates) { |
| roam->num_roam_candidates = num_roam_candidates[i]; |
| |
| for (j = 0; j < num_roam_candidates[i]; j++) { |
| if (score) |
| roam->cand[j].score = score[cand_idx]; |
| if (rssi) |
| roam->cand[j].rssi = rssi[cand_idx]; |
| if (channel) |
| roam->cand[j].freq = |
| channel[cand_idx]; |
| |
| if (bssid) |
| WMI_MAC_ADDR_TO_CHAR_ARRAY( |
| &bssid[cand_idx], |
| roam->cand[j].bssid); |
| |
| cand_idx++; |
| } |
| } |
| |
| if (old_bssid) |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&old_bssid[i], |
| roam->old_bssid); |
| |
| if (new_bssid) |
| WMI_MAC_ADDR_TO_CHAR_ARRAY(&new_bssid[i], |
| roam->new_bssid); |
| } |
| |
| *res_param = res; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_offload_11k_cmd_tlv() - send wmi cmd with 11k offload params |
| * @wmi_handle: wmi handler |
| * @params: pointer to 11k offload params |
| * |
| * Return: 0 for success and non zero for failure |
| */ |
| static QDF_STATUS send_offload_11k_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_11k_offload_params *params) |
| { |
| wmi_11k_offload_report_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| uint8_t *buf_ptr; |
| wmi_neighbor_report_11k_offload_tlv_param |
| *neighbor_report_offload_params; |
| wmi_neighbor_report_offload *neighbor_report_offload; |
| |
| uint32_t len = sizeof(*cmd); |
| |
| if (params->offload_11k_bitmask & |
| WMI_11K_OFFLOAD_BITMAP_NEIGHBOR_REPORT_REQ) |
| len += WMI_TLV_HDR_SIZE + |
| sizeof(wmi_neighbor_report_11k_offload_tlv_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s: failed to allocate memory for 11k offload params", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_11k_offload_report_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_offload_11k_report_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_11k_offload_report_fixed_param)); |
| |
| cmd->vdev_id = params->vdev_id; |
| cmd->offload_11k = params->offload_11k_bitmask; |
| |
| if (params->offload_11k_bitmask & |
| WMI_11K_OFFLOAD_BITMAP_NEIGHBOR_REPORT_REQ) { |
| buf_ptr += sizeof(wmi_11k_offload_report_fixed_param); |
| |
| WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, |
| sizeof(wmi_neighbor_report_11k_offload_tlv_param)); |
| buf_ptr += WMI_TLV_HDR_SIZE; |
| |
| neighbor_report_offload_params = |
| (wmi_neighbor_report_11k_offload_tlv_param *)buf_ptr; |
| WMITLV_SET_HDR(&neighbor_report_offload_params->tlv_header, |
| WMITLV_TAG_STRUC_wmi_neighbor_report_offload_tlv_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_neighbor_report_11k_offload_tlv_param)); |
| |
| neighbor_report_offload = &neighbor_report_offload_params-> |
| neighbor_rep_ofld_params; |
| |
| neighbor_report_offload->time_offset = |
| params->neighbor_report_params.time_offset; |
| neighbor_report_offload->low_rssi_offset = |
| params->neighbor_report_params.low_rssi_offset; |
| neighbor_report_offload->bmiss_count_trigger = |
| params->neighbor_report_params.bmiss_count_trigger; |
| neighbor_report_offload->per_threshold_offset = |
| params->neighbor_report_params.per_threshold_offset; |
| neighbor_report_offload->neighbor_report_cache_timeout = |
| params->neighbor_report_params. |
| neighbor_report_cache_timeout; |
| neighbor_report_offload->max_neighbor_report_req_cap = |
| params->neighbor_report_params. |
| max_neighbor_report_req_cap; |
| neighbor_report_offload->ssid.ssid_len = |
| params->neighbor_report_params.ssid.length; |
| qdf_mem_copy(neighbor_report_offload->ssid.ssid, |
| ¶ms->neighbor_report_params.ssid.mac_ssid, |
| neighbor_report_offload->ssid.ssid_len); |
| } |
| |
| wmi_mtrace(WMI_11K_OFFLOAD_REPORT_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_11K_OFFLOAD_REPORT_CMDID); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: failed to send 11k offload command %d", |
| __func__, status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| /** |
| * send_invoke_neighbor_report_cmd_tlv() - send invoke 11k neighbor report |
| * command |
| * @wmi_handle: wmi handler |
| * @params: pointer to neighbor report invoke params |
| * |
| * Return: 0 for success and non zero for failure |
| */ |
| static QDF_STATUS send_invoke_neighbor_report_cmd_tlv(wmi_unified_t wmi_handle, |
| struct wmi_invoke_neighbor_report_params *params) |
| { |
| wmi_11k_offload_invoke_neighbor_report_fixed_param *cmd; |
| wmi_buf_t buf; |
| QDF_STATUS status; |
| uint8_t *buf_ptr; |
| uint32_t len = sizeof(*cmd); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGP("%s:failed to allocate memory for neighbor invoke cmd", |
| __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| buf_ptr = (uint8_t *) wmi_buf_data(buf); |
| cmd = (wmi_11k_offload_invoke_neighbor_report_fixed_param *) buf_ptr; |
| |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_invoke_neighbor_report_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN( |
| wmi_11k_offload_invoke_neighbor_report_fixed_param)); |
| |
| cmd->vdev_id = params->vdev_id; |
| cmd->flags = params->send_resp_to_host; |
| |
| cmd->ssid.ssid_len = params->ssid.length; |
| qdf_mem_copy(cmd->ssid.ssid, |
| ¶ms->ssid.mac_ssid, |
| cmd->ssid.ssid_len); |
| |
| wmi_mtrace(WMI_11K_INVOKE_NEIGHBOR_REPORT_CMDID, cmd->vdev_id, 0); |
| status = wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_11K_INVOKE_NEIGHBOR_REPORT_CMDID); |
| if (status != QDF_STATUS_SUCCESS) { |
| WMI_LOGE("%s: failed to send invoke neighbor report command %d", |
| __func__, status); |
| wmi_buf_free(buf); |
| } |
| |
| return status; |
| } |
| |
| #ifdef WLAN_SUPPORT_GREEN_AP |
| static QDF_STATUS extract_green_ap_egap_status_info_tlv( |
| uint8_t *evt_buf, |
| struct wlan_green_ap_egap_status_info *egap_status_info_params) |
| { |
| WMI_AP_PS_EGAP_INFO_EVENTID_param_tlvs *param_buf; |
| wmi_ap_ps_egap_info_event_fixed_param *egap_info_event; |
| wmi_ap_ps_egap_info_chainmask_list *chainmask_event; |
| |
| param_buf = (WMI_AP_PS_EGAP_INFO_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("Invalid EGAP Info status event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| egap_info_event = (wmi_ap_ps_egap_info_event_fixed_param *) |
| param_buf->fixed_param; |
| chainmask_event = (wmi_ap_ps_egap_info_chainmask_list *) |
| param_buf->chainmask_list; |
| |
| egap_status_info_params->status = egap_info_event->status; |
| egap_status_info_params->mac_id = chainmask_event->mac_id; |
| egap_status_info_params->tx_chainmask = chainmask_event->tx_chainmask; |
| egap_status_info_params->rx_chainmask = chainmask_event->rx_chainmask; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| #endif |
| |
| /* |
| * send_bss_color_change_enable_cmd_tlv() - Send command to enable or disable of |
| * updating bss color change within firmware when AP announces bss color change. |
| * @wmi_handle: wmi handle |
| * @vdev_id: vdev ID |
| * @enable: enable bss color change within firmware |
| * |
| * Send WMI_BSS_COLOR_CHANGE_ENABLE_CMDID parameters to fw. |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS send_bss_color_change_enable_cmd_tlv(wmi_unified_t wmi_handle, |
| uint32_t vdev_id, |
| bool enable) |
| { |
| wmi_buf_t buf; |
| wmi_bss_color_change_enable_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_bss_color_change_enable_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed to allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_bss_color_change_enable_fixed_param *)wmi_buf_data(buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_bss_color_change_enable_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_bss_color_change_enable_fixed_param)); |
| cmd->vdev_id = vdev_id; |
| cmd->enable = enable; |
| wmi_mtrace(WMI_BSS_COLOR_CHANGE_ENABLE_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_BSS_COLOR_CHANGE_ENABLE_CMDID)) { |
| WMI_LOGE("Failed to send WMI_BSS_COLOR_CHANGE_ENABLE_CMDID"); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * send_obss_color_collision_cfg_cmd_tlv() - send bss color detection |
| * configurations to firmware. |
| * @wmi_handle: wmi handle |
| * @cfg_param: obss detection configurations |
| * |
| * Send WMI_OBSS_COLOR_COLLISION_DET_CONFIG_CMDID parameters to fw. |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS send_obss_color_collision_cfg_cmd_tlv( |
| wmi_unified_t wmi_handle, |
| struct wmi_obss_color_collision_cfg_param *cfg_param) |
| { |
| wmi_buf_t buf; |
| wmi_obss_color_collision_det_config_fixed_param *cmd; |
| uint8_t len = sizeof(wmi_obss_color_collision_det_config_fixed_param); |
| |
| buf = wmi_buf_alloc(wmi_handle, len); |
| if (!buf) { |
| WMI_LOGE("%s: Failed to allocate wmi buffer", __func__); |
| return QDF_STATUS_E_NOMEM; |
| } |
| |
| cmd = (wmi_obss_color_collision_det_config_fixed_param *)wmi_buf_data( |
| buf); |
| WMITLV_SET_HDR(&cmd->tlv_header, |
| WMITLV_TAG_STRUC_wmi_obss_color_collision_det_config_fixed_param, |
| WMITLV_GET_STRUCT_TLVLEN |
| (wmi_obss_color_collision_det_config_fixed_param)); |
| cmd->vdev_id = cfg_param->vdev_id; |
| cmd->flags = cfg_param->flags; |
| cmd->current_bss_color = cfg_param->current_bss_color; |
| cmd->detection_period_ms = cfg_param->detection_period_ms; |
| cmd->scan_period_ms = cfg_param->scan_period_ms; |
| cmd->free_slot_expiry_time_ms = cfg_param->free_slot_expiry_time_ms; |
| |
| switch (cfg_param->evt_type) { |
| case OBSS_COLOR_COLLISION_DETECTION_DISABLE: |
| cmd->evt_type = WMI_BSS_COLOR_COLLISION_DISABLE; |
| break; |
| case OBSS_COLOR_COLLISION_DETECTION: |
| cmd->evt_type = WMI_BSS_COLOR_COLLISION_DETECTION; |
| break; |
| case OBSS_COLOR_FREE_SLOT_TIMER_EXPIRY: |
| cmd->evt_type = WMI_BSS_COLOR_FREE_SLOT_TIMER_EXPIRY; |
| break; |
| case OBSS_COLOR_FREE_SLOT_AVAILABLE: |
| cmd->evt_type = WMI_BSS_COLOR_FREE_SLOT_AVAILABLE; |
| break; |
| default: |
| WMI_LOGE("%s: invalid event type: %d", |
| __func__, cfg_param->evt_type); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| wmi_mtrace(WMI_OBSS_COLOR_COLLISION_DET_CONFIG_CMDID, cmd->vdev_id, 0); |
| if (wmi_unified_cmd_send(wmi_handle, buf, len, |
| WMI_OBSS_COLOR_COLLISION_DET_CONFIG_CMDID)) { |
| WMI_LOGE("%s: Sending OBSS color det cmd failed, vdev_id: %d", |
| __func__, cfg_param->vdev_id); |
| wmi_buf_free(buf); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_obss_color_collision_info_tlv() - Extract bss color collision info |
| * received from firmware. |
| * @evt_buf: pointer to event buffer |
| * @info: Pointer to hold bss collision info |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS extract_obss_color_collision_info_tlv(uint8_t *evt_buf, |
| struct wmi_obss_color_collision_info *info) |
| { |
| WMI_OBSS_COLOR_COLLISION_DETECTION_EVENTID_param_tlvs *param_buf; |
| wmi_obss_color_collision_evt_fixed_param *fix_param; |
| |
| if (!info) { |
| WMI_LOGE("%s: Invalid obss color buffer", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| param_buf = (WMI_OBSS_COLOR_COLLISION_DETECTION_EVENTID_param_tlvs *) |
| evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("%s: Invalid evt_buf", __func__); |
| return QDF_STATUS_E_INVAL; |
| } |
| |
| fix_param = param_buf->fixed_param; |
| info->vdev_id = fix_param->vdev_id; |
| info->obss_color_bitmap_bit0to31 = fix_param->bss_color_bitmap_bit0to31; |
| info->obss_color_bitmap_bit32to63 = |
| fix_param->bss_color_bitmap_bit32to63; |
| |
| switch (fix_param->evt_type) { |
| case WMI_BSS_COLOR_COLLISION_DISABLE: |
| info->evt_type = OBSS_COLOR_COLLISION_DETECTION_DISABLE; |
| break; |
| case WMI_BSS_COLOR_COLLISION_DETECTION: |
| info->evt_type = OBSS_COLOR_COLLISION_DETECTION; |
| break; |
| case WMI_BSS_COLOR_FREE_SLOT_TIMER_EXPIRY: |
| info->evt_type = OBSS_COLOR_FREE_SLOT_TIMER_EXPIRY; |
| break; |
| case WMI_BSS_COLOR_FREE_SLOT_AVAILABLE: |
| info->evt_type = OBSS_COLOR_FREE_SLOT_AVAILABLE; |
| break; |
| default: |
| WMI_LOGE("%s: invalid event type: %d, vdev_id: %d", |
| __func__, fix_param->evt_type, fix_param->vdev_id); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /* |
| * extract_comb_phyerr_tlv() - extract comb phy error from event |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @datalen: data length of event buffer |
| * @buf_offset: Pointer to hold value of current event buffer offset |
| * post extraction |
| * @phyerr: Pointer to hold phyerr |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS extract_comb_phyerr_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, |
| uint16_t datalen, |
| uint16_t *buf_offset, |
| wmi_host_phyerr_t *phyerr) |
| { |
| WMI_PHYERR_EVENTID_param_tlvs *param_tlvs; |
| wmi_comb_phyerr_rx_hdr *pe_hdr; |
| |
| param_tlvs = (WMI_PHYERR_EVENTID_param_tlvs *)evt_buf; |
| if (!param_tlvs) { |
| WMI_LOGD("%s: Received null data from FW", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| pe_hdr = param_tlvs->hdr; |
| if (!pe_hdr) { |
| WMI_LOGD("%s: Received Data PE Header is NULL", __func__); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| /* Ensure it's at least the size of the header */ |
| if (datalen < sizeof(*pe_hdr)) { |
| WMI_LOGD("%s: Expected minimum size %zu, received %d", |
| __func__, sizeof(*pe_hdr), datalen); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| phyerr->pdev_id = wmi_handle->ops-> |
| convert_pdev_id_target_to_host(pe_hdr->pdev_id); |
| phyerr->tsf64 = pe_hdr->tsf_l32; |
| phyerr->tsf64 |= (((uint64_t)pe_hdr->tsf_u32) << 32); |
| phyerr->bufp = param_tlvs->bufp; |
| phyerr->buf_len = pe_hdr->buf_len; |
| phyerr->phy_err_mask0 = pe_hdr->rsPhyErrMask0; |
| phyerr->phy_err_mask1 = pe_hdr->rsPhyErrMask1; |
| *buf_offset = sizeof(*pe_hdr) + sizeof(uint32_t); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_single_phyerr_tlv() - extract single phy error from event |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @datalen: data length of event buffer |
| * @buf_offset: Pointer to hold value of current event buffer offset |
| * post extraction |
| * @phyerr: Pointer to hold phyerr |
| * |
| * Return: QDF_STATUS |
| */ |
| static QDF_STATUS extract_single_phyerr_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, |
| uint16_t datalen, |
| uint16_t *buf_offset, |
| wmi_host_phyerr_t *phyerr) |
| { |
| wmi_single_phyerr_rx_event *ev; |
| uint16_t n = *buf_offset; |
| uint8_t *data = (uint8_t *)evt_buf; |
| |
| if (n < datalen) { |
| if ((datalen - n) < sizeof(ev->hdr)) { |
| WMI_LOGD("%s: Not enough space. len=%d, n=%d, hdr=%zu", |
| __func__, datalen, n, sizeof(ev->hdr)); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| /* |
| * Obtain a pointer to the beginning of the current event. |
| * data[0] is the beginning of the WMI payload. |
| */ |
| ev = (wmi_single_phyerr_rx_event *)&data[n]; |
| |
| /* |
| * Sanity check the buffer length of the event against |
| * what we currently have. |
| * |
| * Since buf_len is 32 bits, we check if it overflows |
| * a large 32 bit value. It's not 0x7fffffff because |
| * we increase n by (buf_len + sizeof(hdr)), which would |
| * in itself cause n to overflow. |
| * |
| * If "int" is 64 bits then this becomes a moot point. |
| */ |
| if (ev->hdr.buf_len > PHYERROR_MAX_BUFFER_LENGTH) { |
| WMI_LOGD("%s: buf_len is garbage 0x%x", |
| __func__, ev->hdr.buf_len); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if ((n + ev->hdr.buf_len) > datalen) { |
| WMI_LOGD("%s: len exceeds n=%d, buf_len=%d, datalen=%d", |
| __func__, n, ev->hdr.buf_len, datalen); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| phyerr->phy_err_code = WMI_UNIFIED_PHYERRCODE_GET(&ev->hdr); |
| phyerr->tsf_timestamp = ev->hdr.tsf_timestamp; |
| phyerr->bufp = &ev->bufp[0]; |
| phyerr->buf_len = ev->hdr.buf_len; |
| phyerr->rf_info.rssi_comb = WMI_UNIFIED_RSSI_COMB_GET(&ev->hdr); |
| |
| /* |
| * Advance the buffer pointer to the next PHY error. |
| * buflen is the length of this payload, so we need to |
| * advance past the current header _AND_ the payload. |
| */ |
| n += sizeof(*ev) + ev->hdr.buf_len; |
| } |
| *buf_offset = n; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * extract_esp_estimation_ev_param_tlv() - extract air time from event |
| * @wmi_handle: wmi handle |
| * @evt_buf: pointer to event buffer |
| * @param: Pointer to hold esp event |
| * |
| * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_INVAL on failure |
| */ |
| static QDF_STATUS |
| extract_esp_estimation_ev_param_tlv(wmi_unified_t wmi_handle, |
| void *evt_buf, |
| struct esp_estimation_event *param) |
| { |
| WMI_ESP_ESTIMATE_EVENTID_param_tlvs *param_buf; |
| wmi_esp_estimate_event_fixed_param *esp_event; |
| |
| param_buf = (WMI_ESP_ESTIMATE_EVENTID_param_tlvs *)evt_buf; |
| if (!param_buf) { |
| WMI_LOGE("Invalid ESP Estimate Event buffer"); |
| return QDF_STATUS_E_INVAL; |
| } |
| esp_event = param_buf->fixed_param; |
| param->ac_airtime_percentage = esp_event->ac_airtime_percentage; |
| param->pdev_id = convert_target_pdev_id_to_host_pdev_id( |
| esp_event->pdev_id); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| struct wmi_ops tlv_ops = { |
| .send_vdev_create_cmd = send_vdev_create_cmd_tlv, |
| .send_vdev_delete_cmd = send_vdev_delete_cmd_tlv, |
| .send_vdev_down_cmd = send_vdev_down_cmd_tlv, |
| .send_vdev_start_cmd = send_vdev_start_cmd_tlv, |
| .send_hidden_ssid_vdev_restart_cmd = |
| send_hidden_ssid_vdev_restart_cmd_tlv, |
| .send_peer_flush_tids_cmd = send_peer_flush_tids_cmd_tlv, |
| .send_peer_param_cmd = send_peer_param_cmd_tlv, |
| .send_vdev_up_cmd = send_vdev_up_cmd_tlv, |
| .send_vdev_stop_cmd = send_vdev_stop_cmd_tlv, |
| .send_peer_create_cmd = send_peer_create_cmd_tlv, |
| .send_peer_delete_cmd = send_peer_delete_cmd_tlv, |
| .send_peer_rx_reorder_queue_setup_cmd = |
| send_peer_rx_reorder_queue_setup_cmd_tlv, |
| .send_peer_rx_reorder_queue_remove_cmd = |
| send_peer_rx_reorder_queue_remove_cmd_tlv, |
| .send_peer_add_wds_entry_cmd = send_peer_add_wds_entry_cmd_tlv, |
| .send_peer_del_wds_entry_cmd = send_peer_del_wds_entry_cmd_tlv, |
| .send_peer_update_wds_entry_cmd = send_peer_update_wds_entry_cmd_tlv, |
| .send_pdev_utf_cmd = send_pdev_utf_cmd_tlv, |
| .send_pdev_param_cmd = send_pdev_param_cmd_tlv, |
| .send_pdev_get_tpc_config_cmd = send_pdev_get_tpc_config_cmd_tlv, |
| .send_suspend_cmd = send_suspend_cmd_tlv, |
| .send_resume_cmd = send_resume_cmd_tlv, |
| #ifdef FEATURE_WLAN_D0WOW |
| .send_d0wow_enable_cmd = send_d0wow_enable_cmd_tlv, |
| .send_d0wow_disable_cmd = send_d0wow_disable_cmd_tlv, |
| #endif |
| .send_wow_enable_cmd = send_wow_enable_cmd_tlv, |
| .send_set_ap_ps_param_cmd = send_set_ap_ps_param_cmd_tlv, |
| .send_set_sta_ps_param_cmd = send_set_sta_ps_param_cmd_tlv, |
| .send_crash_inject_cmd = send_crash_inject_cmd_tlv, |
| #ifdef FEATURE_FW_LOG_PARSING |
| .send_dbglog_cmd = send_dbglog_cmd_tlv, |
| #endif |
| .send_vdev_set_param_cmd = send_vdev_set_param_cmd_tlv, |
| .send_stats_request_cmd = send_stats_request_cmd_tlv, |
| .send_packet_log_enable_cmd = send_packet_log_enable_cmd_tlv, |
| .send_time_stamp_sync_cmd = send_time_stamp_sync_cmd_tlv, |
| .send_packet_log_disable_cmd = send_packet_log_disable_cmd_tlv, |
| .send_beacon_send_cmd = send_beacon_send_cmd_tlv, |
| .send_beacon_tmpl_send_cmd = send_beacon_tmpl_send_cmd_tlv, |
| .send_peer_assoc_cmd = send_peer_assoc_cmd_tlv, |
| .send_scan_start_cmd = send_scan_start_cmd_tlv, |
| .send_scan_stop_cmd = send_scan_stop_cmd_tlv, |
| .send_scan_chan_list_cmd = send_scan_chan_list_cmd_tlv, |
| .send_mgmt_cmd = send_mgmt_cmd_tlv, |
| .send_offchan_data_tx_cmd = send_offchan_data_tx_cmd_tlv, |
| .send_modem_power_state_cmd = send_modem_power_state_cmd_tlv, |
| .send_set_sta_ps_mode_cmd = send_set_sta_ps_mode_cmd_tlv, |
| .send_set_sta_uapsd_auto_trig_cmd = |
| send_set_sta_uapsd_auto_trig_cmd_tlv, |
| .send_get_temperature_cmd = send_get_temperature_cmd_tlv, |
| .send_set_p2pgo_oppps_req_cmd = send_set_p2pgo_oppps_req_cmd_tlv, |
| .send_set_p2pgo_noa_req_cmd = send_set_p2pgo_noa_req_cmd_tlv, |
| #ifdef FEATURE_P2P_LISTEN_OFFLOAD |
| .send_p2p_lo_start_cmd = send_p2p_lo_start_cmd_tlv, |
| .send_p2p_lo_stop_cmd = send_p2p_lo_stop_cmd_tlv, |
| #endif |
| .send_set_smps_params_cmd = send_set_smps_params_cmd_tlv, |
| .send_set_mimops_cmd = send_set_mimops_cmd_tlv, |
| #ifdef WLAN_FEATURE_DSRC |
| .send_ocb_set_utc_time_cmd = send_ocb_set_utc_time_cmd_tlv, |
| .send_ocb_get_tsf_timer_cmd = send_ocb_get_tsf_timer_cmd_tlv, |
| .send_dcc_clear_stats_cmd = send_dcc_clear_stats_cmd_tlv, |
| .send_dcc_get_stats_cmd = send_dcc_get_stats_cmd_tlv, |
| .send_dcc_update_ndl_cmd = send_dcc_update_ndl_cmd_tlv, |
| .send_ocb_set_config_cmd = send_ocb_set_config_cmd_tlv, |
| .send_ocb_stop_timing_advert_cmd = send_ocb_stop_timing_advert_cmd_tlv, |
| .send_ocb_start_timing_advert_cmd = |
| send_ocb_start_timing_advert_cmd_tlv, |
| .extract_ocb_chan_config_resp = extract_ocb_channel_config_resp_tlv, |
| .extract_ocb_tsf_timer = extract_ocb_tsf_timer_tlv, |
| .extract_dcc_update_ndl_resp = extract_ocb_ndl_resp_tlv, |
| .extract_dcc_stats = extract_ocb_dcc_stats_tlv, |
| #endif |
| .send_set_enable_disable_mcc_adaptive_scheduler_cmd = |
| send_set_enable_disable_mcc_adaptive_scheduler_cmd_tlv, |
| .send_set_mcc_channel_time_latency_cmd = |
| send_set_mcc_channel_time_latency_cmd_tlv, |
| .send_set_mcc_channel_time_quota_cmd = |
| send_set_mcc_channel_time_quota_cmd_tlv, |
| .send_set_thermal_mgmt_cmd = send_set_thermal_mgmt_cmd_tlv, |
| .send_lro_config_cmd = send_lro_config_cmd_tlv, |
| .send_peer_rate_report_cmd = send_peer_rate_report_cmd_tlv, |
| .send_set_sta_sa_query_param_cmd = send_set_sta_sa_query_param_cmd_tlv, |
| .send_set_sta_keep_alive_cmd = send_set_sta_keep_alive_cmd_tlv, |
| .send_vdev_set_gtx_cfg_cmd = send_vdev_set_gtx_cfg_cmd_tlv, |
| .send_probe_rsp_tmpl_send_cmd = |
| send_probe_rsp_tmpl_send_cmd_tlv, |
| .send_p2p_go_set_beacon_ie_cmd = |
| send_p2p_go_set_beacon_ie_cmd_tlv, |
| .send_setup_install_key_cmd = |
| send_setup_install_key_cmd_tlv, |
| .send_set_gateway_params_cmd = |
| send_set_gateway_params_cmd_tlv, |
| .send_set_rssi_monitoring_cmd = |
| send_set_rssi_monitoring_cmd_tlv, |
| .send_scan_probe_setoui_cmd = |
| send_scan_probe_setoui_cmd_tlv, |
| .send_roam_scan_offload_rssi_thresh_cmd = |
| send_roam_scan_offload_rssi_thresh_cmd_tlv, |
| .send_roam_mawc_params_cmd = send_roam_mawc_params_cmd_tlv, |
| .send_roam_scan_filter_cmd = |
| send_roam_scan_filter_cmd_tlv, |
| #ifdef IPA_OFFLOAD |
| .send_ipa_offload_control_cmd = |
| send_ipa_offload_control_cmd_tlv, |
| #endif |
| .send_plm_stop_cmd = send_plm_stop_cmd_tlv, |
| .send_plm_start_cmd = send_plm_start_cmd_tlv, |
| .send_pno_stop_cmd = send_pno_stop_cmd_tlv, |
| .send_pno_start_cmd = send_pno_start_cmd_tlv, |
| .send_nlo_mawc_cmd = send_nlo_mawc_cmd_tlv, |
| #ifdef WLAN_FEATURE_ROAM_OFFLOAD |
| .send_set_ric_req_cmd = send_set_ric_req_cmd_tlv, |
| .send_process_roam_synch_complete_cmd = |
| send_process_roam_synch_complete_cmd_tlv, |
| #endif |
| #ifdef WLAN_FEATURE_LINK_LAYER_STATS |
| .send_process_ll_stats_clear_cmd = send_process_ll_stats_clear_cmd_tlv, |
| .send_process_ll_stats_set_cmd = send_process_ll_stats_set_cmd_tlv, |
| .send_process_ll_stats_get_cmd = send_process_ll_stats_get_cmd_tlv, |
| #endif /* WLAN_FEATURE_LINK_LAYER_STATS*/ |
| .send_congestion_cmd = send_congestion_cmd_tlv, |
| .send_snr_request_cmd = send_snr_request_cmd_tlv, |
| .send_snr_cmd = send_snr_cmd_tlv, |
| .send_link_status_req_cmd = send_link_status_req_cmd_tlv, |
| #ifdef WLAN_POWER_MANAGEMENT_OFFLOAD |
| .send_add_wow_wakeup_event_cmd = send_add_wow_wakeup_event_cmd_tlv, |
| .send_wow_patterns_to_fw_cmd = send_wow_patterns_to_fw_cmd_tlv, |
| .send_enable_arp_ns_offload_cmd = send_enable_arp_ns_offload_cmd_tlv, |
| .send_add_clear_mcbc_filter_cmd = send_add_clear_mcbc_filter_cmd_tlv, |
| .send_multiple_add_clear_mcbc_filter_cmd = |
| send_multiple_add_clear_mcbc_filter_cmd_tlv, |
| .send_conf_hw_filter_cmd = send_conf_hw_filter_cmd_tlv, |
| .send_gtk_offload_cmd = send_gtk_offload_cmd_tlv, |
| .send_process_gtk_offload_getinfo_cmd = |
| send_process_gtk_offload_getinfo_cmd_tlv, |
| .send_enable_enhance_multicast_offload_cmd = |
| send_enable_enhance_multicast_offload_tlv, |
| .extract_gtk_rsp_event = extract_gtk_rsp_event_tlv, |
| #ifdef FEATURE_WLAN_RA_FILTERING |
| .send_wow_sta_ra_filter_cmd = send_wow_sta_ra_filter_cmd_tlv, |
| #endif |
| .send_action_frame_patterns_cmd = send_action_frame_patterns_cmd_tlv, |
| .send_lphb_config_hbenable_cmd = send_lphb_config_hbenable_cmd_tlv, |
| .send_lphb_config_tcp_params_cmd = send_lphb_config_tcp_params_cmd_tlv, |
| .send_lphb_config_tcp_pkt_filter_cmd = |
| send_lphb_config_tcp_pkt_filter_cmd_tlv, |
| .send_lphb_config_udp_params_cmd = send_lphb_config_udp_params_cmd_tlv, |
| .send_lphb_config_udp_pkt_filter_cmd = |
| send_lphb_config_udp_pkt_filter_cmd_tlv, |
| #ifdef WLAN_FEATURE_PACKET_FILTERING |
| .send_enable_disable_packet_filter_cmd = |
| send_enable_disable_packet_filter_cmd_tlv, |
| .send_config_packet_filter_cmd = send_config_packet_filter_cmd_tlv, |
| #endif |
| #endif /* End of WLAN_POWER_MANAGEMENT_OFFLOAD */ |
| #ifdef CONFIG_MCL |
| .send_process_dhcp_ind_cmd = send_process_dhcp_ind_cmd_tlv, |
| .send_get_link_speed_cmd = send_get_link_speed_cmd_tlv, |
| .send_bcn_buf_ll_cmd = send_bcn_buf_ll_cmd_tlv, |
| .send_roam_scan_offload_mode_cmd = |
| send_roam_scan_offload_mode_cmd_tlv, |
| #ifndef REMOVE_PKT_LOG |
| .send_pktlog_wmi_send_cmd = send_pktlog_wmi_send_cmd_tlv, |
| #endif |
| .send_roam_scan_offload_ap_profile_cmd = |
| send_roam_scan_offload_ap_profile_cmd_tlv, |
| #endif |
| #ifdef WLAN_SUPPORT_GREEN_AP |
| .send_egap_conf_params_cmd = send_egap_conf_params_cmd_tlv, |
| .send_green_ap_ps_cmd = send_green_ap_ps_cmd_tlv, |
| .extract_green_ap_egap_status_info = |
| extract_green_ap_egap_status_info_tlv, |
| #endif |
| .send_fw_profiling_cmd = send_fw_profiling_cmd_tlv, |
| .send_csa_offload_enable_cmd = send_csa_offload_enable_cmd_tlv, |
| .send_nat_keepalive_en_cmd = send_nat_keepalive_en_cmd_tlv, |
| .send_wlm_latency_level_cmd = send_wlm_latency_level_cmd_tlv, |
| .send_start_oem_data_cmd = send_start_oem_data_cmd_tlv, |
| #ifdef WLAN_FEATURE_CIF_CFR |
| .send_oem_dma_cfg_cmd = send_oem_dma_cfg_cmd_tlv, |
| #endif |
| .send_dbr_cfg_cmd = send_dbr_cfg_cmd_tlv, |
| .send_dfs_phyerr_filter_offload_en_cmd = |
| send_dfs_phyerr_filter_offload_en_cmd_tlv, |
| .send_wow_delete_pattern_cmd = send_wow_delete_pattern_cmd_tlv, |
| .send_host_wakeup_ind_to_fw_cmd = send_host_wakeup_ind_to_fw_cmd_tlv, |
| .send_del_ts_cmd = send_del_ts_cmd_tlv, |
| .send_aggr_qos_cmd = send_aggr_qos_cmd_tlv, |
| .send_add_ts_cmd = send_add_ts_cmd_tlv, |
| .send_process_add_periodic_tx_ptrn_cmd = |
| send_process_add_periodic_tx_ptrn_cmd_tlv, |
| .send_process_del_periodic_tx_ptrn_cmd = |
| send_process_del_periodic_tx_ptrn_cmd_tlv, |
| .send_stats_ext_req_cmd = send_stats_ext_req_cmd_tlv, |
| .send_enable_ext_wow_cmd = send_enable_ext_wow_cmd_tlv, |
| .send_set_app_type2_params_in_fw_cmd = |
| send_set_app_type2_params_in_fw_cmd_tlv, |
| .send_set_auto_shutdown_timer_cmd = |
| send_set_auto_shutdown_timer_cmd_tlv, |
| .send_nan_req_cmd = send_nan_req_cmd_tlv, |
| .send_process_dhcpserver_offload_cmd = |
| send_process_dhcpserver_offload_cmd_tlv, |
| .send_set_led_flashing_cmd = send_set_led_flashing_cmd_tlv, |
| .send_process_ch_avoid_update_cmd = |
| send_process_ch_avoid_update_cmd_tlv, |
| .send_pdev_set_regdomain_cmd = |
| send_pdev_set_regdomain_cmd_tlv, |
| .send_regdomain_info_to_fw_cmd = send_regdomain_info_to_fw_cmd_tlv, |
| .send_set_tdls_offchan_mode_cmd = send_set_tdls_offchan_mode_cmd_tlv, |
| .send_update_fw_tdls_state_cmd = send_update_fw_tdls_state_cmd_tlv, |
| .send_update_tdls_peer_state_cmd = send_update_tdls_peer_state_cmd_tlv, |
| .send_process_set_ie_info_cmd = send_process_set_ie_info_cmd_tlv, |
| .save_fw_version_cmd = save_fw_version_cmd_tlv, |
| .check_and_update_fw_version = |
| check_and_update_fw_version_cmd_tlv, |
| .send_set_base_macaddr_indicate_cmd = |
| send_set_base_macaddr_indicate_cmd_tlv, |
| .send_log_supported_evt_cmd = send_log_supported_evt_cmd_tlv, |
| .send_enable_specific_fw_logs_cmd = |
| send_enable_specific_fw_logs_cmd_tlv, |
| .send_flush_logs_to_fw_cmd = send_flush_logs_to_fw_cmd_tlv, |
| .send_pdev_set_pcl_cmd = send_pdev_set_pcl_cmd_tlv, |
| .send_pdev_set_hw_mode_cmd = send_pdev_set_hw_mode_cmd_tlv, |
| #ifdef WLAN_POLICY_MGR_ENABLE |
| .send_pdev_set_dual_mac_config_cmd = |
| send_pdev_set_dual_mac_config_cmd_tlv, |
| #endif |
| .send_app_type1_params_in_fw_cmd = |
| send_app_type1_params_in_fw_cmd_tlv, |
| .send_set_ssid_hotlist_cmd = send_set_ssid_hotlist_cmd_tlv, |
| .send_unit_test_cmd = send_unit_test_cmd_tlv, |
| .send_roam_invoke_cmd = send_roam_invoke_cmd_tlv, |
| .send_roam_scan_offload_cmd = send_roam_scan_offload_cmd_tlv, |
| .send_roam_scan_offload_scan_period_cmd = |
| send_roam_scan_offload_scan_period_cmd_tlv, |
| .send_roam_scan_offload_chan_list_cmd = |
| send_roam_scan_offload_chan_list_cmd_tlv, |
| .send_roam_scan_offload_rssi_change_cmd = |
| send_roam_scan_offload_rssi_change_cmd_tlv, |
| #ifdef FEATURE_WLAN_APF |
| .send_set_active_apf_mode_cmd = wmi_send_set_active_apf_mode_cmd_tlv, |
| .send_apf_enable_cmd = wmi_send_apf_enable_cmd_tlv, |
| .send_apf_write_work_memory_cmd = |
| wmi_send_apf_write_work_memory_cmd_tlv, |
| .send_apf_read_work_memory_cmd = |
| wmi_send_apf_read_work_memory_cmd_tlv, |
| .extract_apf_read_memory_resp_event = |
| wmi_extract_apf_read_memory_resp_event_tlv, |
| #endif /* FEATURE_WLAN_APF */ |
| .send_adapt_dwelltime_params_cmd = |
| send_adapt_dwelltime_params_cmd_tlv, |
| .send_dbs_scan_sel_params_cmd = |
| send_dbs_scan_sel_params_cmd_tlv, |
| .init_cmd_send = init_cmd_send_tlv, |
| .send_smart_ant_enable_cmd = send_smart_ant_enable_cmd_tlv, |
| .send_smart_ant_set_rx_ant_cmd = send_smart_ant_set_rx_ant_cmd_tlv, |
| .send_set_ctl_table_cmd = send_set_ctl_table_cmd_tlv, |
| .send_set_mimogain_table_cmd = send_set_mimogain_table_cmd_tlv, |
| .send_packet_power_info_get_cmd = send_packet_power_info_get_cmd_tlv, |
| .send_vdev_config_ratemask_cmd = send_vdev_config_ratemask_cmd_tlv, |
| .send_vdev_set_custom_aggr_size_cmd = |
| send_vdev_set_custom_aggr_size_cmd_tlv, |
| .send_vdev_set_qdepth_thresh_cmd = |
| send_vdev_set_qdepth_thresh_cmd_tlv, |
| .send_set_vap_dscp_tid_map_cmd = send_set_vap_dscp_tid_map_cmd_tlv, |
| .send_vdev_set_neighbour_rx_cmd = send_vdev_set_neighbour_rx_cmd_tlv, |
| .send_smart_ant_set_tx_ant_cmd = send_smart_ant_set_tx_ant_cmd_tlv, |
| .send_set_ant_switch_tbl_cmd = send_set_ant_switch_tbl_cmd_tlv, |
| .send_smart_ant_set_training_info_cmd = |
| send_smart_ant_set_training_info_cmd_tlv, |
| .send_smart_ant_set_node_config_cmd = |
| send_smart_ant_set_node_config_cmd_tlv, |
| #ifdef WLAN_ATF_ENABLE |
| .send_set_atf_cmd = send_set_atf_cmd_tlv, |
| #endif |
| .send_vdev_set_fwtest_param_cmd = send_vdev_set_fwtest_param_cmd_tlv, |
| .send_set_qboost_param_cmd = send_set_qboost_param_cmd_tlv, |
| .send_gpio_config_cmd = send_gpio_config_cmd_tlv, |
| .send_gpio_output_cmd = send_gpio_output_cmd_tlv, |
| .send_phyerr_disable_cmd = send_phyerr_disable_cmd_tlv, |
| .send_phyerr_enable_cmd = send_phyerr_enable_cmd_tlv, |
| .send_periodic_chan_stats_config_cmd = |
| send_periodic_chan_stats_config_cmd_tlv, |
| .send_nf_dbr_dbm_info_get_cmd = send_nf_dbr_dbm_info_get_cmd_tlv, |
| .send_set_ht_ie_cmd = send_set_ht_ie_cmd_tlv, |
| .send_set_vht_ie_cmd = send_set_vht_ie_cmd_tlv, |
| .send_set_quiet_mode_cmd = send_set_quiet_mode_cmd_tlv, |
| .send_set_bwf_cmd = send_set_bwf_cmd_tlv, |
| .send_mcast_group_update_cmd = send_mcast_group_update_cmd_tlv, |
| .send_vdev_spectral_configure_cmd = |
| send_vdev_spectral_configure_cmd_tlv, |
| .send_vdev_spectral_enable_cmd = |
| send_vdev_spectral_enable_cmd_tlv, |
| .send_thermal_mitigation_param_cmd = |
| send_thermal_mitigation_param_cmd_tlv, |
| .send_pdev_qvit_cmd = send_pdev_qvit_cmd_tlv, |
| .send_wmm_update_cmd = send_wmm_update_cmd_tlv, |
| .send_process_update_edca_param_cmd = |
| send_process_update_edca_param_cmd_tlv, |
| .send_coex_config_cmd = send_coex_config_cmd_tlv, |
| .send_set_country_cmd = send_set_country_cmd_tlv, |
| .send_bcn_offload_control_cmd = send_bcn_offload_control_cmd_tlv, |
| .send_addba_send_cmd = send_addba_send_cmd_tlv, |
| .send_delba_send_cmd = send_delba_send_cmd_tlv, |
| .send_addba_clearresponse_cmd = send_addba_clearresponse_cmd_tlv, |
| .get_target_cap_from_service_ready = extract_service_ready_tlv, |
| .extract_hal_reg_cap = extract_hal_reg_cap_tlv, |
| .extract_host_mem_req = extract_host_mem_req_tlv, |
| .save_service_bitmap = save_service_bitmap_tlv, |
| .save_ext_service_bitmap = save_ext_service_bitmap_tlv, |
| .is_service_enabled = is_service_enabled_tlv, |
| .save_fw_version = save_fw_version_in_service_ready_tlv, |
| .ready_extract_init_status = ready_extract_init_status_tlv, |
| .ready_extract_mac_addr = ready_extract_mac_addr_tlv, |
| .ready_extract_mac_addr_list = ready_extract_mac_addr_list_tlv, |
| .extract_ready_event_params = extract_ready_event_params_tlv, |
| .extract_dbglog_data_len = extract_dbglog_data_len_tlv, |
| .extract_vdev_start_resp = extract_vdev_start_resp_tlv, |
| .extract_vdev_delete_resp = extract_vdev_delete_resp_tlv, |
| .extract_tbttoffset_update_params = |
| extract_tbttoffset_update_params_tlv, |
| .extract_ext_tbttoffset_update_params = |
| extract_ext_tbttoffset_update_params_tlv, |
| .extract_tbttoffset_num_vdevs = |
| extract_tbttoffset_num_vdevs_tlv, |
| .extract_ext_tbttoffset_num_vdevs = |
| extract_ext_tbttoffset_num_vdevs_tlv, |
| .extract_mgmt_rx_params = extract_mgmt_rx_params_tlv, |
| .extract_vdev_stopped_param = extract_vdev_stopped_param_tlv, |
| .extract_vdev_roam_param = extract_vdev_roam_param_tlv, |
| .extract_vdev_scan_ev_param = extract_vdev_scan_ev_param_tlv, |
| #ifdef CONVERGED_TDLS_ENABLE |
| .extract_vdev_tdls_ev_param = extract_vdev_tdls_ev_param_tlv, |
| #endif |
| .extract_mgmt_tx_compl_param = extract_mgmt_tx_compl_param_tlv, |
| .extract_swba_num_vdevs = extract_swba_num_vdevs_tlv, |
| .extract_swba_tim_info = extract_swba_tim_info_tlv, |
| .extract_swba_noa_info = extract_swba_noa_info_tlv, |
| #ifdef CONVERGED_P2P_ENABLE |
| .extract_p2p_noa_ev_param = extract_p2p_noa_ev_param_tlv, |
| #ifdef FEATURE_P2P_LISTEN_OFFLOAD |
| .extract_p2p_lo_stop_ev_param = |
| extract_p2p_lo_stop_ev_param_tlv, |
| #endif |
| #endif |
| .extract_offchan_data_tx_compl_param = |
| extract_offchan_data_tx_compl_param_tlv, |
| .extract_peer_sta_kickout_ev = extract_peer_sta_kickout_ev_tlv, |
| .extract_all_stats_count = extract_all_stats_counts_tlv, |
| .extract_pdev_stats = extract_pdev_stats_tlv, |
| .extract_unit_test = extract_unit_test_tlv, |
| .extract_pdev_ext_stats = extract_pdev_ext_stats_tlv, |
| .extract_vdev_stats = extract_vdev_stats_tlv, |
| .extract_per_chain_rssi_stats = extract_per_chain_rssi_stats_tlv, |
| .extract_peer_stats = extract_peer_stats_tlv, |
| .extract_bcn_stats = extract_bcn_stats_tlv, |
| .extract_bcnflt_stats = extract_bcnflt_stats_tlv, |
| .extract_peer_extd_stats = extract_peer_extd_stats_tlv, |
| .extract_chan_stats = extract_chan_stats_tlv, |
| .extract_profile_ctx = extract_profile_ctx_tlv, |
| .extract_profile_data = extract_profile_data_tlv, |
| .extract_chan_info_event = extract_chan_info_event_tlv, |
| .extract_channel_hopping_event = extract_channel_hopping_event_tlv, |
| .send_fw_test_cmd = send_fw_test_cmd_tlv, |
| #ifdef WLAN_FEATURE_DISA |
| .send_encrypt_decrypt_send_cmd = |
| send_encrypt_decrypt_send_cmd_tlv, |
| .extract_encrypt_decrypt_resp_event = |
| extract_encrypt_decrypt_resp_event_tlv, |
| #endif |
| .send_sar_limit_cmd = send_sar_limit_cmd_tlv, |
| .get_sar_limit_cmd = get_sar_limit_cmd_tlv, |
| .extract_sar_limit_event = extract_sar_limit_event_tlv, |
| .extract_sar2_result_event = extract_sar2_result_event_tlv, |
| .send_power_dbg_cmd = send_power_dbg_cmd_tlv, |
| .send_multiple_vdev_restart_req_cmd = |
| send_multiple_vdev_restart_req_cmd_tlv, |
| .extract_service_ready_ext = extract_service_ready_ext_tlv, |
| .extract_hw_mode_cap_service_ready_ext = |
| extract_hw_mode_cap_service_ready_ext_tlv, |
| .extract_mac_phy_cap_service_ready_ext = |
| extract_mac_phy_cap_service_ready_ext_tlv, |
| .extract_reg_cap_service_ready_ext = |
| extract_reg_cap_service_ready_ext_tlv, |
| .extract_dbr_ring_cap_service_ready_ext = |
| extract_dbr_ring_cap_service_ready_ext_tlv, |
| .extract_sar_cap_service_ready_ext = |
| extract_sar_cap_service_ready_ext_tlv, |
| .extract_dbr_buf_release_fixed = extract_dbr_buf_release_fixed_tlv, |
| .extract_dbr_buf_release_entry = extract_dbr_buf_release_entry_tlv, |
| .extract_dbr_buf_metadata = extract_dbr_buf_metadata_tlv, |
| .extract_pdev_utf_event = extract_pdev_utf_event_tlv, |
| .wmi_set_htc_tx_tag = wmi_set_htc_tx_tag_tlv, |
| .extract_dcs_interference_type = extract_dcs_interference_type_tlv, |
| .extract_dcs_cw_int = extract_dcs_cw_int_tlv, |
| .extract_dcs_im_tgt_stats = extract_dcs_im_tgt_stats_tlv, |
| .extract_fips_event_data = extract_fips_event_data_tlv, |
| .send_pdev_fips_cmd = send_pdev_fips_cmd_tlv, |
| .extract_peer_delete_response_event = |
| extract_peer_delete_response_event_tlv, |
| .is_management_record = is_management_record_tlv, |
| .extract_pdev_csa_switch_count_status = |
| extract_pdev_csa_switch_count_status_tlv, |
| .extract_pdev_tpc_ev_param = extract_pdev_tpc_ev_param_tlv, |
| .extract_pdev_tpc_config_ev_param = |
| extract_pdev_tpc_config_ev_param_tlv, |
| .extract_nfcal_power_ev_param = extract_nfcal_power_ev_param_tlv, |
| .extract_wds_addr_event = extract_wds_addr_event_tlv, |
| .extract_peer_sta_ps_statechange_ev = |
| extract_peer_sta_ps_statechange_ev_tlv, |
| .extract_inst_rssi_stats_event = extract_inst_rssi_stats_event_tlv, |
| .send_per_roam_config_cmd = send_per_roam_config_cmd_tlv, |
| #ifdef WLAN_FEATURE_ACTION_OUI |
| .send_action_oui_cmd = send_action_oui_cmd_tlv, |
| #endif |
| .send_dfs_phyerr_offload_en_cmd = send_dfs_phyerr_offload_en_cmd_tlv, |
| .send_dfs_phyerr_offload_dis_cmd = send_dfs_phyerr_offload_dis_cmd_tlv, |
| .extract_reg_chan_list_update_event = |
| extract_reg_chan_list_update_event_tlv, |
| .extract_chainmask_tables = |
| extract_chainmask_tables_tlv, |
| .extract_thermal_stats = extract_thermal_stats_tlv, |
| .extract_thermal_level_stats = extract_thermal_level_stats_tlv, |
| .send_get_rcpi_cmd = send_get_rcpi_cmd_tlv, |
| .extract_rcpi_response_event = extract_rcpi_response_event_tlv, |
| #ifdef DFS_COMPONENT_ENABLE |
| .extract_dfs_cac_complete_event = extract_dfs_cac_complete_event_tlv, |
| .extract_dfs_radar_detection_event = |
| extract_dfs_radar_detection_event_tlv, |
| .extract_wlan_radar_event_info = extract_wlan_radar_event_info_tlv, |
| #endif |
| .convert_pdev_id_host_to_target = |
| convert_host_pdev_id_to_target_pdev_id_legacy, |
| .convert_pdev_id_target_to_host = |
| convert_target_pdev_id_to_host_pdev_id_legacy, |
| |
| .send_start_11d_scan_cmd = send_start_11d_scan_cmd_tlv, |
| .send_stop_11d_scan_cmd = send_stop_11d_scan_cmd_tlv, |
| .extract_reg_11d_new_country_event = |
| extract_reg_11d_new_country_event_tlv, |
| .send_user_country_code_cmd = send_user_country_code_cmd_tlv, |
| .send_limit_off_chan_cmd = |
| send_limit_off_chan_cmd_tlv, |
| .extract_reg_ch_avoid_event = |
| extract_reg_ch_avoid_event_tlv, |
| .send_pdev_caldata_version_check_cmd = |
| send_pdev_caldata_version_check_cmd_tlv, |
| .extract_pdev_caldata_version_check_ev_param = |
| extract_pdev_caldata_version_check_ev_param_tlv, |
| .send_set_arp_stats_req_cmd = send_set_arp_stats_req_cmd_tlv, |
| .send_get_arp_stats_req_cmd = send_get_arp_stats_req_cmd_tlv, |
| .send_set_del_pmkid_cache_cmd = send_set_del_pmkid_cache_cmd_tlv, |
| #if defined(WLAN_FEATURE_FILS_SK) |
| .send_roam_scan_hlp_cmd = send_roam_scan_send_hlp_cmd_tlv, |
| #endif |
| .send_wow_timer_pattern_cmd = send_wow_timer_pattern_cmd_tlv, |
| #ifdef WLAN_FEATURE_NAN_CONVERGENCE |
| .send_ndp_initiator_req_cmd = nan_ndp_initiator_req_tlv, |
| .send_ndp_responder_req_cmd = nan_ndp_responder_req_tlv, |
| .send_ndp_end_req_cmd = nan_ndp_end_req_tlv, |
| .extract_ndp_initiator_rsp = extract_ndp_initiator_rsp_tlv, |
| .extract_ndp_ind = extract_ndp_ind_tlv, |
| .extract_ndp_confirm = extract_ndp_confirm_tlv, |
| .extract_ndp_responder_rsp = extract_ndp_responder_rsp_tlv, |
| .extract_ndp_end_rsp = extract_ndp_end_rsp_tlv, |
| .extract_ndp_end_ind = extract_ndp_end_ind_tlv, |
| .extract_ndp_sch_update = extract_ndp_sch_update_tlv, |
| #endif |
| .send_btm_config = send_btm_config_cmd_tlv, |
| .send_obss_detection_cfg_cmd = send_obss_detection_cfg_cmd_tlv, |
| .extract_obss_detection_info = extract_obss_detection_info_tlv, |
| #ifdef WLAN_SUPPORT_FILS |
| .send_vdev_fils_enable_cmd = send_vdev_fils_enable_cmd_tlv, |
| .extract_swfda_vdev_id = extract_swfda_vdev_id_tlv, |
| .send_fils_discovery_send_cmd = send_fils_discovery_send_cmd_tlv, |
| #endif /* WLAN_SUPPORT_FILS */ |
| .send_offload_11k_cmd = send_offload_11k_cmd_tlv, |
| .send_invoke_neighbor_report_cmd = send_invoke_neighbor_report_cmd_tlv, |
| .wmi_pdev_id_conversion_enable = wmi_tlv_pdev_id_conversion_enable, |
| .wmi_free_allocated_event = wmitlv_free_allocated_event_tlvs, |
| .wmi_check_and_pad_event = wmitlv_check_and_pad_event_tlvs, |
| .wmi_check_command_params = wmitlv_check_command_tlv_params, |
| .send_bss_color_change_enable_cmd = |
| send_bss_color_change_enable_cmd_tlv, |
| .send_obss_color_collision_cfg_cmd = |
| send_obss_color_collision_cfg_cmd_tlv, |
| .extract_obss_color_collision_info = |
| extract_obss_color_collision_info_tlv, |
| .extract_comb_phyerr = extract_comb_phyerr_tlv, |
| .extract_single_phyerr = extract_single_phyerr_tlv, |
| #ifdef QCA_SUPPORT_CP_STATS |
| .extract_cca_stats = extract_cca_stats_tlv, |
| #endif |
| .extract_esp_estimation_ev_param = |
| extract_esp_estimation_ev_param_tlv, |
| .send_roam_scan_stats_cmd = send_roam_scan_stats_cmd_tlv, |
| .extract_roam_scan_stats_res_evt = extract_roam_scan_stats_res_evt_tlv, |
| #ifdef OBSS_PD |
| .send_obss_spatial_reuse_set = send_obss_spatial_reuse_set_cmd_tlv, |
| #endif |
| }; |
| |
| /** |
| * populate_tlv_event_id() - populates wmi event ids |
| * |
| * @param event_ids: Pointer to hold event ids |
| * Return: None |
| */ |
| static void populate_tlv_events_id(uint32_t *event_ids) |
| { |
| event_ids[wmi_service_ready_event_id] = WMI_SERVICE_READY_EVENTID; |
| event_ids[wmi_ready_event_id] = WMI_READY_EVENTID; |
| event_ids[wmi_scan_event_id] = WMI_SCAN_EVENTID; |
| event_ids[wmi_pdev_tpc_config_event_id] = WMI_PDEV_TPC_CONFIG_EVENTID; |
| event_ids[wmi_chan_info_event_id] = WMI_CHAN_INFO_EVENTID; |
| event_ids[wmi_phyerr_event_id] = WMI_PHYERR_EVENTID; |
| event_ids[wmi_pdev_dump_event_id] = WMI_PDEV_DUMP_EVENTID; |
| event_ids[wmi_tx_pause_event_id] = WMI_TX_PAUSE_EVENTID; |
| event_ids[wmi_dfs_radar_event_id] = WMI_DFS_RADAR_EVENTID; |
| event_ids[wmi_pdev_l1ss_track_event_id] = WMI_PDEV_L1SS_TRACK_EVENTID; |
| event_ids[wmi_pdev_temperature_event_id] = WMI_PDEV_TEMPERATURE_EVENTID; |
| event_ids[wmi_service_ready_ext_event_id] = |
| WMI_SERVICE_READY_EXT_EVENTID; |
| event_ids[wmi_vdev_start_resp_event_id] = WMI_VDEV_START_RESP_EVENTID; |
| event_ids[wmi_vdev_stopped_event_id] = WMI_VDEV_STOPPED_EVENTID; |
| event_ids[wmi_vdev_install_key_complete_event_id] = |
| WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID; |
| event_ids[wmi_vdev_mcc_bcn_intvl_change_req_event_id] = |
| WMI_VDEV_MCC_BCN_INTERVAL_CHANGE_REQ_EVENTID; |
| |
| event_ids[wmi_vdev_tsf_report_event_id] = WMI_VDEV_TSF_REPORT_EVENTID; |
| event_ids[wmi_peer_sta_kickout_event_id] = WMI_PEER_STA_KICKOUT_EVENTID; |
| event_ids[wmi_peer_info_event_id] = WMI_PEER_INFO_EVENTID; |
| event_ids[wmi_peer_tx_fail_cnt_thr_event_id] = |
| WMI_PEER_TX_FAIL_CNT_THR_EVENTID; |
| event_ids[wmi_peer_estimated_linkspeed_event_id] = |
| WMI_PEER_ESTIMATED_LINKSPEED_EVENTID; |
| event_ids[wmi_peer_state_event_id] = WMI_PEER_STATE_EVENTID; |
| event_ids[wmi_peer_delete_response_event_id] = |
| WMI_PEER_DELETE_RESP_EVENTID; |
| event_ids[wmi_mgmt_rx_event_id] = WMI_MGMT_RX_EVENTID; |
| event_ids[wmi_host_swba_event_id] = WMI_HOST_SWBA_EVENTID; |
| event_ids[wmi_tbttoffset_update_event_id] = |
| WMI_TBTTOFFSET_UPDATE_EVENTID; |
| event_ids[wmi_ext_tbttoffset_update_event_id] = |
| WMI_TBTTOFFSET_EXT_UPDATE_EVENTID; |
| event_ids[wmi_offload_bcn_tx_status_event_id] = |
| WMI_OFFLOAD_BCN_TX_STATUS_EVENTID; |
| event_ids[wmi_offload_prob_resp_tx_status_event_id] = |
| WMI_OFFLOAD_PROB_RESP_TX_STATUS_EVENTID; |
| event_ids[wmi_mgmt_tx_completion_event_id] = |
| WMI_MGMT_TX_COMPLETION_EVENTID; |
| event_ids[wmi_pdev_nfcal_power_all_channels_event_id] = |
| WMI_PDEV_NFCAL_POWER_ALL_CHANNELS_EVENTID; |
| event_ids[wmi_tx_delba_complete_event_id] = |
| WMI_TX_DELBA_COMPLETE_EVENTID; |
| event_ids[wmi_tx_addba_complete_event_id] = |
| WMI_TX_ADDBA_COMPLETE_EVENTID; |
| event_ids[wmi_ba_rsp_ssn_event_id] = WMI_BA_RSP_SSN_EVENTID; |
| |
| event_ids[wmi_aggr_state_trig_event_id] = WMI_AGGR_STATE_TRIG_EVENTID; |
| |
| event_ids[wmi_roam_event_id] = WMI_ROAM_EVENTID; |
| event_ids[wmi_profile_match] = WMI_PROFILE_MATCH; |
| |
| event_ids[wmi_roam_synch_event_id] = WMI_ROAM_SYNCH_EVENTID; |
| event_ids[wmi_roam_synch_frame_event_id] = WMI_ROAM_SYNCH_FRAME_EVENTID; |
| |
| event_ids[wmi_p2p_disc_event_id] = WMI_P2P_DISC_EVENTID; |
| |
| event_ids[wmi_p2p_noa_event_id] = WMI_P2P_NOA_EVENTID; |
| event_ids[wmi_p2p_lo_stop_event_id] = |
| WMI_P2P_LISTEN_OFFLOAD_STOPPED_EVENTID; |
| event_ids[wmi_pdev_resume_event_id] = WMI_PDEV_RESUME_EVENTID; |
| event_ids[wmi_wow_wakeup_host_event_id] = WMI_WOW_WAKEUP_HOST_EVENTID; |
| event_ids[wmi_d0_wow_disable_ack_event_id] = |
| WMI_D0_WOW_DISABLE_ACK_EVENTID; |
| event_ids[wmi_wow_initial_wakeup_event_id] = |
| WMI_WOW_INITIAL_WAKEUP_EVENTID; |
| |
| event_ids[wmi_rtt_meas_report_event_id] = |
| WMI_RTT_MEASUREMENT_REPORT_EVENTID; |
| event_ids[wmi_tsf_meas_report_event_id] = |
| WMI_TSF_MEASUREMENT_REPORT_EVENTID; |
| event_ids[wmi_rtt_error_report_event_id] = WMI_RTT_ERROR_REPORT_EVENTID; |
| event_ids[wmi_stats_ext_event_id] = WMI_STATS_EXT_EVENTID; |
| event_ids[wmi_iface_link_stats_event_id] = WMI_IFACE_LINK_STATS_EVENTID; |
| event_ids[wmi_peer_link_stats_event_id] = WMI_PEER_LINK_STATS_EVENTID; |
| event_ids[wmi_radio_link_stats_link] = WMI_RADIO_LINK_STATS_EVENTID; |
| event_ids[wmi_diag_event_id_log_supported_event_id] = |
| WMI_DIAG_EVENT_LOG_SUPPORTED_EVENTID; |
| event_ids[wmi_nlo_match_event_id] = WMI_NLO_MATCH_EVENTID; |
| event_ids[wmi_nlo_scan_complete_event_id] = |
| WMI_NLO_SCAN_COMPLETE_EVENTID; |
| event_ids[wmi_apfind_event_id] = WMI_APFIND_EVENTID; |
| event_ids[wmi_passpoint_match_event_id] = WMI_PASSPOINT_MATCH_EVENTID; |
| |
| event_ids[wmi_gtk_offload_status_event_id] = |
| WMI_GTK_OFFLOAD_STATUS_EVENTID; |
| event_ids[wmi_gtk_rekey_fail_event_id] = WMI_GTK_REKEY_FAIL_EVENTID; |
| event_ids[wmi_csa_handling_event_id] = WMI_CSA_HANDLING_EVENTID; |
| event_ids[wmi_chatter_pc_query_event_id] = WMI_CHATTER_PC_QUERY_EVENTID; |
| |
| event_ids[wmi_echo_event_id] = WMI_ECHO_EVENTID; |
| |
| event_ids[wmi_pdev_utf_event_id] = WMI_PDEV_UTF_EVENTID; |
| |
| event_ids[wmi_dbg_msg_event_id] = WMI_DEBUG_MESG_EVENTID; |
| event_ids[wmi_update_stats_event_id] = WMI_UPDATE_STATS_EVENTID; |
| event_ids[wmi_debug_print_event_id] = WMI_DEBUG_PRINT_EVENTID; |
| event_ids[wmi_dcs_interference_event_id] = WMI_DCS_INTERFERENCE_EVENTID; |
| event_ids[wmi_pdev_qvit_event_id] = WMI_PDEV_QVIT_EVENTID; |
| event_ids[wmi_wlan_profile_data_event_id] = |
| WMI_WLAN_PROFILE_DATA_EVENTID; |
| event_ids[wmi_pdev_ftm_intg_event_id] = WMI_PDEV_FTM_INTG_EVENTID; |
| event_ids[wmi_wlan_freq_avoid_event_id] = WMI_WLAN_FREQ_AVOID_EVENTID; |
| event_ids[wmi_vdev_get_keepalive_event_id] = |
| WMI_VDEV_GET_KEEPALIVE_EVENTID; |
| event_ids[wmi_thermal_mgmt_event_id] = WMI_THERMAL_MGMT_EVENTID; |
| |
| event_ids[wmi_diag_container_event_id] = |
| WMI_DIAG_DATA_CONTAINER_EVENTID; |
| |
| event_ids[wmi_host_auto_shutdown_event_id] = |
| WMI_HOST_AUTO_SHUTDOWN_EVENTID; |
| |
| event_ids[wmi_update_whal_mib_stats_event_id] = |
| WMI_UPDATE_WHAL_MIB_STATS_EVENTID; |
| |
| /*update ht/vht info based on vdev (rx and tx NSS and preamble) */ |
| event_ids[wmi_update_vdev_rate_stats_event_id] = |
| WMI_UPDATE_VDEV_RATE_STATS_EVENTID; |
| |
| event_ids[wmi_diag_event_id] = WMI_DIAG_EVENTID; |
| event_ids[wmi_unit_test_event_id] = WMI_UNIT_TEST_EVENTID; |
| |
| /** Set OCB Sched Response, deprecated */ |
| event_ids[wmi_ocb_set_sched_event_id] = WMI_OCB_SET_SCHED_EVENTID; |
| |
| event_ids[wmi_dbg_mesg_flush_complete_event_id] = |
| WMI_DEBUG_MESG_FLUSH_COMPLETE_EVENTID; |
| event_ids[wmi_rssi_breach_event_id] = WMI_RSSI_BREACH_EVENTID; |
| |
| /* GPIO Event */ |
| event_ids[wmi_gpio_input_event_id] = WMI_GPIO_INPUT_EVENTID; |
| event_ids[wmi_uploadh_event_id] = WMI_UPLOADH_EVENTID; |
| |
| event_ids[wmi_captureh_event_id] = WMI_CAPTUREH_EVENTID; |
| event_ids[wmi_rfkill_state_change_event_id] = |
| WMI_RFKILL_STATE_CHANGE_EVENTID; |
| |
| /* TDLS Event */ |
| event_ids[wmi_tdls_peer_event_id] = WMI_TDLS_PEER_EVENTID; |
| |
| event_ids[wmi_batch_scan_enabled_event_id] = |
| WMI_BATCH_SCAN_ENABLED_EVENTID; |
| event_ids[wmi_batch_scan_result_event_id] = |
| WMI_BATCH_SCAN_RESULT_EVENTID; |
| /* OEM Event */ |
| event_ids[wmi_oem_cap_event_id] = WMI_OEM_CAPABILITY_EVENTID; |
| event_ids[wmi_oem_meas_report_event_id] = |
| WMI_OEM_MEASUREMENT_REPORT_EVENTID; |
| event_ids[wmi_oem_report_event_id] = WMI_OEM_ERROR_REPORT_EVENTID; |
| |
| /* NAN Event */ |
| event_ids[wmi_nan_event_id] = WMI_NAN_EVENTID; |
| |
| /* LPI Event */ |
| event_ids[wmi_lpi_result_event_id] = WMI_LPI_RESULT_EVENTID; |
| event_ids[wmi_lpi_status_event_id] = WMI_LPI_STATUS_EVENTID; |
| event_ids[wmi_lpi_handoff_event_id] = WMI_LPI_HANDOFF_EVENTID; |
| |
| /* ExtScan events */ |
| event_ids[wmi_extscan_start_stop_event_id] = |
| WMI_EXTSCAN_START_STOP_EVENTID; |
| event_ids[wmi_extscan_operation_event_id] = |
| WMI_EXTSCAN_OPERATION_EVENTID; |
| event_ids[wmi_extscan_table_usage_event_id] = |
| WMI_EXTSCAN_TABLE_USAGE_EVENTID; |
| event_ids[wmi_extscan_cached_results_event_id] = |
| WMI_EXTSCAN_CACHED_RESULTS_EVENTID; |
| event_ids[wmi_extscan_wlan_change_results_event_id] = |
| WMI_EXTSCAN_WLAN_CHANGE_RESULTS_EVENTID; |
| event_ids[wmi_extscan_hotlist_match_event_id] = |
| WMI_EXTSCAN_HOTLIST_MATCH_EVENTID; |
| event_ids[wmi_extscan_capabilities_event_id] = |
| WMI_EXTSCAN_CAPABILITIES_EVENTID; |
| event_ids[wmi_extscan_hotlist_ssid_match_event_id] = |
| WMI_EXTSCAN_HOTLIST_SSID_MATCH_EVENTID; |
| |
| /* mDNS offload events */ |
| event_ids[wmi_mdns_stats_event_id] = WMI_MDNS_STATS_EVENTID; |
| |
| /* SAP Authentication offload events */ |
| event_ids[wmi_sap_ofl_add_sta_event_id] = WMI_SAP_OFL_ADD_STA_EVENTID; |
| event_ids[wmi_sap_ofl_del_sta_event_id] = WMI_SAP_OFL_DEL_STA_EVENTID; |
| |
| /** Out-of-context-of-bss (OCB) events */ |
| event_ids[wmi_ocb_set_config_resp_event_id] = |
| WMI_OCB_SET_CONFIG_RESP_EVENTID; |
| event_ids[wmi_ocb_get_tsf_timer_resp_event_id] = |
| WMI_OCB_GET_TSF_TIMER_RESP_EVENTID; |
| event_ids[wmi_dcc_get_stats_resp_event_id] = |
| WMI_DCC_GET_STATS_RESP_EVENTID; |
| event_ids[wmi_dcc_update_ndl_resp_event_id] = |
| WMI_DCC_UPDATE_NDL_RESP_EVENTID; |
| event_ids[wmi_dcc_stats_event_id] = WMI_DCC_STATS_EVENTID; |
| /* System-On-Chip events */ |
| event_ids[wmi_soc_set_hw_mode_resp_event_id] = |
| WMI_SOC_SET_HW_MODE_RESP_EVENTID; |
| event_ids[wmi_soc_hw_mode_transition_event_id] = |
| WMI_SOC_HW_MODE_TRANSITION_EVENTID; |
| event_ids[wmi_soc_set_dual_mac_config_resp_event_id] = |
| WMI_SOC_SET_DUAL_MAC_CONFIG_RESP_EVENTID; |
| event_ids[wmi_pdev_fips_event_id] = WMI_PDEV_FIPS_EVENTID; |
| event_ids[wmi_pdev_csa_switch_count_status_event_id] = |
| WMI_PDEV_CSA_SWITCH_COUNT_STATUS_EVENTID; |
| event_ids[wmi_reg_chan_list_cc_event_id] = WMI_REG_CHAN_LIST_CC_EVENTID; |
| event_ids[wmi_inst_rssi_stats_event_id] = WMI_INST_RSSI_STATS_EVENTID; |
| event_ids[wmi_pdev_tpc_config_event_id] = WMI_PDEV_TPC_CONFIG_EVENTID; |
| event_ids[wmi_peer_sta_ps_statechg_event_id] = |
| WMI_PEER_STA_PS_STATECHG_EVENTID; |
| event_ids[wmi_pdev_channel_hopping_event_id] = |
| WMI_PDEV_CHANNEL_HOPPING_EVENTID; |
| event_ids[wmi_offchan_data_tx_completion_event] = |
| WMI_OFFCHAN_DATA_TX_COMPLETION_EVENTID; |
| event_ids[wmi_dfs_cac_complete_id] = WMI_VDEV_DFS_CAC_COMPLETE_EVENTID; |
| event_ids[wmi_dfs_radar_detection_event_id] = |
| WMI_PDEV_DFS_RADAR_DETECTION_EVENTID; |
| event_ids[wmi_tt_stats_event_id] = WMI_THERM_THROT_STATS_EVENTID; |
| event_ids[wmi_11d_new_country_event_id] = WMI_11D_NEW_COUNTRY_EVENTID; |
| event_ids[wmi_pdev_tpc_event_id] = WMI_PDEV_TPC_EVENTID; |
| event_ids[wmi_get_arp_stats_req_id] = WMI_VDEV_GET_ARP_STAT_EVENTID; |
| event_ids[wmi_service_available_event_id] = |
| WMI_SERVICE_AVAILABLE_EVENTID; |
| event_ids[wmi_update_rcpi_event_id] = WMI_UPDATE_RCPI_EVENTID; |
| event_ids[wmi_pdev_check_cal_version_event_id] = WMI_PDEV_CHECK_CAL_VERSION_EVENTID; |
| /* NDP events */ |
| event_ids[wmi_ndp_initiator_rsp_event_id] = |
| WMI_NDP_INITIATOR_RSP_EVENTID; |
| event_ids[wmi_ndp_indication_event_id] = WMI_NDP_INDICATION_EVENTID; |
| event_ids[wmi_ndp_confirm_event_id] = WMI_NDP_CONFIRM_EVENTID; |
| event_ids[wmi_ndp_responder_rsp_event_id] = |
| WMI_NDP_RESPONDER_RSP_EVENTID; |
| event_ids[wmi_ndp_end_indication_event_id] = |
| WMI_NDP_END_INDICATION_EVENTID; |
| event_ids[wmi_ndp_end_rsp_event_id] = WMI_NDP_END_RSP_EVENTID; |
| event_ids[wmi_ndl_schedule_update_event_id] = |
| WMI_NDL_SCHEDULE_UPDATE_EVENTID; |
| |
| event_ids[wmi_oem_response_event_id] = WMI_OEM_RESPONSE_EVENTID; |
| event_ids[wmi_peer_stats_info_event_id] = WMI_PEER_STATS_INFO_EVENTID; |
| event_ids[wmi_pdev_chip_power_stats_event_id] = |
| WMI_PDEV_CHIP_POWER_STATS_EVENTID; |
| event_ids[wmi_ap_ps_egap_info_event_id] = WMI_AP_PS_EGAP_INFO_EVENTID; |
| event_ids[wmi_peer_assoc_conf_event_id] = WMI_PEER_ASSOC_CONF_EVENTID; |
| event_ids[wmi_vdev_delete_resp_event_id] = WMI_VDEV_DELETE_RESP_EVENTID; |
| event_ids[wmi_apf_capability_info_event_id] = |
| WMI_BPF_CAPABILIY_INFO_EVENTID; |
| event_ids[wmi_vdev_encrypt_decrypt_data_rsp_event_id] = |
| WMI_VDEV_ENCRYPT_DECRYPT_DATA_RESP_EVENTID; |
| event_ids[wmi_report_rx_aggr_failure_event_id] = |
| WMI_REPORT_RX_AGGR_FAILURE_EVENTID; |
| event_ids[wmi_pdev_chip_pwr_save_failure_detect_event_id] = |
| WMI_PDEV_CHIP_POWER_SAVE_FAILURE_DETECTED_EVENTID; |
| event_ids[wmi_peer_antdiv_info_event_id] = WMI_PEER_ANTDIV_INFO_EVENTID; |
| event_ids[wmi_pdev_set_hw_mode_rsp_event_id] = |
| WMI_PDEV_SET_HW_MODE_RESP_EVENTID; |
| event_ids[wmi_pdev_hw_mode_transition_event_id] = |
| WMI_PDEV_HW_MODE_TRANSITION_EVENTID; |
| event_ids[wmi_pdev_set_mac_config_resp_event_id] = |
| WMI_PDEV_SET_MAC_CONFIG_RESP_EVENTID; |
| event_ids[wmi_coex_bt_activity_event_id] = |
| WMI_WLAN_COEX_BT_ACTIVITY_EVENTID; |
| event_ids[wmi_mgmt_tx_bundle_completion_event_id] = |
| WMI_MGMT_TX_BUNDLE_COMPLETION_EVENTID; |
| event_ids[wmi_radio_tx_power_level_stats_event_id] = |
| WMI_RADIO_TX_POWER_LEVEL_STATS_EVENTID; |
| event_ids[wmi_report_stats_event_id] = WMI_REPORT_STATS_EVENTID; |
| event_ids[wmi_dma_buf_release_event_id] = |
| WMI_PDEV_DMA_RING_BUF_RELEASE_EVENTID; |
| event_ids[wmi_sap_obss_detection_report_event_id] = |
| WMI_SAP_OBSS_DETECTION_REPORT_EVENTID; |
| event_ids[wmi_host_swfda_event_id] = WMI_HOST_SWFDA_EVENTID; |
| event_ids[wmi_sar_get_limits_event_id] = WMI_SAR_GET_LIMITS_EVENTID; |
| event_ids[wmi_obss_color_collision_report_event_id] = |
| WMI_OBSS_COLOR_COLLISION_DETECTION_EVENTID; |
| event_ids[wmi_pdev_div_rssi_antid_event_id] = |
| WMI_PDEV_DIV_RSSI_ANTID_EVENTID; |
| event_ids[wmi_twt_enable_complete_event_id] = |
| WMI_TWT_ENABLE_COMPLETE_EVENTID; |
| event_ids[wmi_apf_get_vdev_work_memory_resp_event_id] = |
| WMI_BPF_GET_VDEV_WORK_MEMORY_RESP_EVENTID; |
| event_ids[wmi_wlan_sar2_result_event_id] = WMI_SAR2_RESULT_EVENTID; |
| event_ids[wmi_esp_estimate_event_id] = WMI_ESP_ESTIMATE_EVENTID; |
| event_ids[wmi_roam_scan_stats_event_id] = WMI_ROAM_SCAN_STATS_EVENTID; |
| #ifdef AST_HKV1_WORKAROUND |
| event_ids[wmi_wds_peer_event_id] = WMI_WDS_PEER_EVENTID; |
| #endif |
| } |
| |
| /** |
| * populate_tlv_service() - populates wmi services |
| * |
| * @param wmi_service: Pointer to hold wmi_service |
| * Return: None |
| */ |
| static void populate_tlv_service(uint32_t *wmi_service) |
| { |
| wmi_service[wmi_service_beacon_offload] = WMI_SERVICE_BEACON_OFFLOAD; |
| wmi_service[wmi_service_ack_timeout] = WMI_SERVICE_ACK_TIMEOUT; |
| wmi_service[wmi_service_scan_offload] = WMI_SERVICE_SCAN_OFFLOAD; |
| wmi_service[wmi_service_roam_scan_offload] = |
| WMI_SERVICE_ROAM_SCAN_OFFLOAD; |
| wmi_service[wmi_service_bcn_miss_offload] = |
| WMI_SERVICE_BCN_MISS_OFFLOAD; |
| wmi_service[wmi_service_sta_pwrsave] = WMI_SERVICE_STA_PWRSAVE; |
| wmi_service[wmi_service_sta_advanced_pwrsave] = |
| WMI_SERVICE_STA_ADVANCED_PWRSAVE; |
| wmi_service[wmi_service_ap_uapsd] = WMI_SERVICE_AP_UAPSD; |
| wmi_service[wmi_service_ap_dfs] = WMI_SERVICE_AP_DFS; |
| wmi_service[wmi_service_11ac] = WMI_SERVICE_11AC; |
| wmi_service[wmi_service_blockack] = WMI_SERVICE_BLOCKACK; |
| wmi_service[wmi_service_phyerr] = WMI_SERVICE_PHYERR; |
| wmi_service[wmi_service_bcn_filter] = WMI_SERVICE_BCN_FILTER; |
| wmi_service[wmi_service_rtt] = WMI_SERVICE_RTT; |
| wmi_service[wmi_service_wow] = WMI_SERVICE_WOW; |
| wmi_service[wmi_service_ratectrl_cache] = WMI_SERVICE_RATECTRL_CACHE; |
| wmi_service[wmi_service_iram_tids] = WMI_SERVICE_IRAM_TIDS; |
| wmi_service[wmi_service_arpns_offload] = WMI_SERVICE_ARPNS_OFFLOAD; |
| wmi_service[wmi_service_nlo] = WMI_SERVICE_NLO; |
| wmi_service[wmi_service_gtk_offload] = WMI_SERVICE_GTK_OFFLOAD; |
| wmi_service[wmi_service_scan_sch] = WMI_SERVICE_SCAN_SCH; |
| wmi_service[wmi_service_csa_offload] = WMI_SERVICE_CSA_OFFLOAD; |
| wmi_service[wmi_service_chatter] = WMI_SERVICE_CHATTER; |
| wmi_service[wmi_service_coex_freqavoid] = WMI_SERVICE_COEX_FREQAVOID; |
| wmi_service[wmi_service_packet_power_save] = |
| WMI_SERVICE_PACKET_POWER_SAVE; |
| wmi_service[wmi_service_force_fw_hang] = WMI_SERVICE_FORCE_FW_HANG; |
| wmi_service[wmi_service_gpio] = WMI_SERVICE_GPIO; |
| wmi_service[wmi_service_sta_dtim_ps_modulated_dtim] = |
| WMI_SERVICE_STA_DTIM_PS_MODULATED_DTIM; |
| wmi_service[wmi_sta_uapsd_basic_auto_trig] = |
| WMI_STA_UAPSD_BASIC_AUTO_TRIG; |
| wmi_service[wmi_sta_uapsd_var_auto_trig] = WMI_STA_UAPSD_VAR_AUTO_TRIG; |
| wmi_service[wmi_service_sta_keep_alive] = WMI_SERVICE_STA_KEEP_ALIVE; |
| wmi_service[wmi_service_tx_encap] = WMI_SERVICE_TX_ENCAP; |
| wmi_service[wmi_service_ap_ps_detect_out_of_sync] = |
| WMI_SERVICE_AP_PS_DETECT_OUT_OF_SYNC; |
| wmi_service[wmi_service_early_rx] = WMI_SERVICE_EARLY_RX; |
| wmi_service[wmi_service_sta_smps] = WMI_SERVICE_STA_SMPS; |
| wmi_service[wmi_service_fwtest] = WMI_SERVICE_FWTEST; |
| wmi_service[wmi_service_sta_wmmac] = WMI_SERVICE_STA_WMMAC; |
| wmi_service[wmi_service_tdls] = WMI_SERVICE_TDLS; |
| wmi_service[wmi_service_burst] = WMI_SERVICE_BURST; |
| wmi_service[wmi_service_mcc_bcn_interval_change] = |
| WMI_SERVICE_MCC_BCN_INTERVAL_CHANGE; |
| wmi_service[wmi_service_adaptive_ocs] = WMI_SERVICE_ADAPTIVE_OCS; |
| wmi_service[wmi_service_ba_ssn_support] = WMI_SERVICE_BA_SSN_SUPPORT; |
| wmi_service[wmi_service_filter_ipsec_natkeepalive] = |
| WMI_SERVICE_FILTER_IPSEC_NATKEEPALIVE; |
| wmi_service[wmi_service_wlan_hb] = WMI_SERVICE_WLAN_HB; |
| wmi_service[wmi_service_lte_ant_share_support] = |
| WMI_SERVICE_LTE_ANT_SHARE_SUPPORT; |
| wmi_service[wmi_service_batch_scan] = WMI_SERVICE_BATCH_SCAN; |
| wmi_service[wmi_service_qpower] = WMI_SERVICE_QPOWER; |
| wmi_service[wmi_service_plmreq] = WMI_SERVICE_PLMREQ; |
| wmi_service[wmi_service_thermal_mgmt] = WMI_SERVICE_THERMAL_MGMT; |
| wmi_service[wmi_service_rmc] = WMI_SERVICE_RMC; |
| wmi_service[wmi_service_mhf_offload] = WMI_SERVICE_MHF_OFFLOAD; |
| wmi_service[wmi_service_coex_sar] = WMI_SERVICE_COEX_SAR; |
| wmi_service[wmi_service_bcn_txrate_override] = |
| WMI_SERVICE_BCN_TXRATE_OVERRIDE; |
| wmi_service[wmi_service_nan] = WMI_SERVICE_NAN; |
| wmi_service[wmi_service_l1ss_stat] = WMI_SERVICE_L1SS_STAT; |
| wmi_service[wmi_service_estimate_linkspeed] = |
| WMI_SERVICE_ESTIMATE_LINKSPEED; |
| wmi_service[wmi_service_obss_scan] = WMI_SERVICE_OBSS_SCAN; |
| wmi_service[wmi_service_tdls_offchan] = WMI_SERVICE_TDLS_OFFCHAN; |
| wmi_service[wmi_service_tdls_uapsd_buffer_sta] = |
| WMI_SERVICE_TDLS_UAPSD_BUFFER_STA; |
| wmi_service[wmi_service_tdls_uapsd_sleep_sta] = |
| WMI_SERVICE_TDLS_UAPSD_SLEEP_STA; |
| wmi_service[wmi_service_ibss_pwrsave] = WMI_SERVICE_IBSS_PWRSAVE; |
| wmi_service[wmi_service_lpass] = WMI_SERVICE_LPASS; |
| wmi_service[wmi_service_extscan] = WMI_SERVICE_EXTSCAN; |
| wmi_service[wmi_service_d0wow] = WMI_SERVICE_D0WOW; |
| wmi_service[wmi_service_hsoffload] = WMI_SERVICE_HSOFFLOAD; |
| wmi_service[wmi_service_roam_ho_offload] = WMI_SERVICE_ROAM_HO_OFFLOAD; |
| wmi_service[wmi_service_rx_full_reorder] = WMI_SERVICE_RX_FULL_REORDER; |
| wmi_service[wmi_service_dhcp_offload] = WMI_SERVICE_DHCP_OFFLOAD; |
| wmi_service[wmi_service_sta_rx_ipa_offload_support] = |
| WMI_SERVICE_STA_RX_IPA_OFFLOAD_SUPPORT; |
| wmi_service[wmi_service_mdns_offload] = WMI_SERVICE_MDNS_OFFLOAD; |
| wmi_service[wmi_service_sap_auth_offload] = |
| WMI_SERVICE_SAP_AUTH_OFFLOAD; |
| wmi_service[wmi_service_dual_band_simultaneous_support] = |
| WMI_SERVICE_DUAL_BAND_SIMULTANEOUS_SUPPORT; |
| wmi_service[wmi_service_ocb] = WMI_SERVICE_OCB; |
| wmi_service[wmi_service_ap_arpns_offload] = |
| WMI_SERVICE_AP_ARPNS_OFFLOAD; |
| wmi_service[wmi_service_per_band_chainmask_support] = |
| WMI_SERVICE_PER_BAND_CHAINMASK_SUPPORT; |
| wmi_service[wmi_service_packet_filter_offload] = |
| WMI_SERVICE_PACKET_FILTER_OFFLOAD; |
| wmi_service[wmi_service_mgmt_tx_htt] = WMI_SERVICE_MGMT_TX_HTT; |
| wmi_service[wmi_service_mgmt_tx_wmi] = WMI_SERVICE_MGMT_TX_WMI; |
| wmi_service[wmi_service_ext_msg] = WMI_SERVICE_EXT_MSG; |
| wmi_service[wmi_service_mawc] = WMI_SERVICE_MAWC; |
| wmi_service[wmi_service_multiple_vdev_restart] = |
| WMI_SERVICE_MULTIPLE_VDEV_RESTART; |
| |
| wmi_service[wmi_service_roam_offload] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_ratectrl] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_smart_antenna_sw_support] = |
| WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_smart_antenna_hw_support] = |
| WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_enhanced_proxy_sta] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_tt] = WMI_SERVICE_THERM_THROT; |
| wmi_service[wmi_service_atf] = WMI_SERVICE_ATF; |
| wmi_service[wmi_service_peer_caching] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_coex_gpio] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_aux_spectral_intf] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_aux_chan_load_intf] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_bss_channel_info_64] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_ext_res_cfg_support] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_mesh] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_restrt_chnl_support] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_peer_stats] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_mesh_11s] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_periodic_chan_stat_support] = |
| WMI_SERVICE_PERIODIC_CHAN_STAT_SUPPORT; |
| wmi_service[wmi_service_tx_mode_push_only] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_tx_mode_push_pull] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_tx_mode_dynamic] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_btcoex_duty_cycle] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_4_wire_coex_support] = WMI_SERVICE_UNAVAILABLE; |
| wmi_service[wmi_service_mesh] = WMI_SERVICE_ENTERPRISE_MESH; |
| wmi_service[wmi_service_peer_assoc_conf] = WMI_SERVICE_PEER_ASSOC_CONF; |
| wmi_service[wmi_service_egap] = WMI_SERVICE_EGAP; |
| wmi_service[wmi_service_sta_pmf_offload] = WMI_SERVICE_STA_PMF_OFFLOAD; |
| wmi_service[wmi_service_unified_wow_capability] = |
| WMI_SERVICE_UNIFIED_WOW_CAPABILITY; |
| wmi_service[wmi_service_enterprise_mesh] = WMI_SERVICE_ENTERPRISE_MESH; |
| wmi_service[wmi_service_apf_offload] = WMI_SERVICE_BPF_OFFLOAD; |
| wmi_service[wmi_service_sync_delete_cmds] = |
| WMI_SERVICE_SYNC_DELETE_CMDS; |
| wmi_service[wmi_service_ratectrl_limit_max_min_rates] = |
| WMI_SERVICE_RATECTRL_LIMIT_MAX_MIN_RATES; |
| wmi_service[wmi_service_nan_data] = WMI_SERVICE_NAN_DATA; |
| wmi_service[wmi_service_nan_rtt] = WMI_SERVICE_NAN_RTT; |
| wmi_service[wmi_service_11ax] = WMI_SERVICE_11AX; |
| wmi_service[wmi_service_deprecated_replace] = |
| WMI_SERVICE_DEPRECATED_REPLACE; |
| wmi_service[wmi_service_tdls_conn_tracker_in_host_mode] = |
| WMI_SERVICE_TDLS_CONN_TRACKER_IN_HOST_MODE; |
| wmi_service[wmi_service_enhanced_mcast_filter] = |
| WMI_SERVICE_ENHANCED_MCAST_FILTER; |
| wmi_service[wmi_service_half_rate_quarter_rate_support] = |
| WMI_SERVICE_HALF_RATE_QUARTER_RATE_SUPPORT; |
| wmi_service[wmi_service_vdev_rx_filter] = WMI_SERVICE_VDEV_RX_FILTER; |
| wmi_service[wmi_service_p2p_listen_offload_support] = |
| WMI_SERVICE_P2P_LISTEN_OFFLOAD_SUPPORT; |
| wmi_service[wmi_service_mark_first_wakeup_packet] = |
| WMI_SERVICE_MARK_FIRST_WAKEUP_PACKET; |
| wmi_service[wmi_service_multiple_mcast_filter_set] = |
| WMI_SERVICE_MULTIPLE_MCAST_FILTER_SET; |
| wmi_service[wmi_service_host_managed_rx_reorder] = |
| WMI_SERVICE_HOST_MANAGED_RX_REORDER; |
| wmi_service[wmi_service_flash_rdwr_support] = |
| WMI_SERVICE_FLASH_RDWR_SUPPORT; |
| wmi_service[wmi_service_wlan_stats_report] = |
| WMI_SERVICE_WLAN_STATS_REPORT; |
| wmi_service[wmi_service_tx_msdu_id_new_partition_support] = |
| WMI_SERVICE_TX_MSDU_ID_NEW_PARTITION_SUPPORT; |
| wmi_service[wmi_service_dfs_phyerr_offload] = |
| WMI_SERVICE_DFS_PHYERR_OFFLOAD; |
| wmi_service[wmi_service_rcpi_support] = WMI_SERVICE_RCPI_SUPPORT; |
| wmi_service[wmi_service_fw_mem_dump_support] = |
| WMI_SERVICE_FW_MEM_DUMP_SUPPORT; |
| wmi_service[wmi_service_peer_stats_info] = WMI_SERVICE_PEER_STATS_INFO; |
| wmi_service[wmi_service_regulatory_db] = WMI_SERVICE_REGULATORY_DB; |
| wmi_service[wmi_service_11d_offload] = WMI_SERVICE_11D_OFFLOAD; |
| wmi_service[wmi_service_hw_data_filtering] = |
| WMI_SERVICE_HW_DATA_FILTERING; |
| wmi_service[wmi_service_pkt_routing] = WMI_SERVICE_PKT_ROUTING; |
| wmi_service[wmi_service_offchan_tx_wmi] = WMI_SERVICE_OFFCHAN_TX_WMI; |
| wmi_service[wmi_service_chan_load_info] = WMI_SERVICE_CHAN_LOAD_INFO; |
| wmi_service[wmi_service_extended_nss_support] = |
| WMI_SERVICE_EXTENDED_NSS_SUPPORT; |
| wmi_service[wmi_service_widebw_scan] = WMI_SERVICE_SCAN_PHYMODE_SUPPORT; |
| wmi_service[wmi_service_bcn_offload_start_stop_support] = |
| WMI_SERVICE_BCN_OFFLOAD_START_STOP_SUPPORT; |
| wmi_service[wmi_service_offchan_data_tid_support] = |
| WMI_SERVICE_OFFCHAN_DATA_TID_SUPPORT; |
| wmi_service[wmi_service_support_dma] = |
| WMI_SERVICE_SUPPORT_DIRECT_DMA; |
| wmi_service[wmi_service_8ss_tx_bfee] = WMI_SERVICE_8SS_TX_BFEE; |
| wmi_service[wmi_service_fils_support] = WMI_SERVICE_FILS_SUPPORT; |
| wmi_service[wmi_service_mawc_support] = WMI_SERVICE_MAWC_SUPPORT; |
| wmi_service[wmi_service_wow_wakeup_by_timer_pattern] = |
| WMI_SERVICE_WOW_WAKEUP_BY_TIMER_PATTERN; |
| wmi_service[wmi_service_11k_neighbour_report_support] = |
| WMI_SERVICE_11K_NEIGHBOUR_REPORT_SUPPORT; |
| wmi_service[wmi_service_ap_obss_detection_offload] = |
| WMI_SERVICE_AP_OBSS_DETECTION_OFFLOAD; |
| wmi_service[wmi_service_bss_color_offload] = |
| WMI_SERVICE_BSS_COLOR_OFFLOAD; |
| wmi_service[wmi_service_gmac_offload_support] = |
| WMI_SERVICE_GMAC_OFFLOAD_SUPPORT; |
| wmi_service[wmi_service_dual_beacon_on_single_mac_scc_support] = |
| WMI_SERVICE_DUAL_BEACON_ON_SINGLE_MAC_SCC_SUPPORT; |
| wmi_service[wmi_service_dual_beacon_on_single_mac_mcc_support] = |
| WMI_SERVICE_DUAL_BEACON_ON_SINGLE_MAC_MCC_SUPPORT; |
| wmi_service[wmi_service_twt_requestor] = WMI_SERVICE_STA_TWT; |
| wmi_service[wmi_service_twt_responder] = WMI_SERVICE_AP_TWT; |
| wmi_service[wmi_service_listen_interval_offload_support] = |
| WMI_SERVICE_LISTEN_INTERVAL_OFFLOAD_SUPPORT; |
| wmi_service[wmi_service_obss_spatial_reuse] = |
| WMI_SERVICE_OBSS_SPATIAL_REUSE; |
| |
| } |
| |
| #ifndef CONFIG_MCL |
| |
| /** |
| * populate_pdev_param_tlv() - populates pdev params |
| * |
| * @param pdev_param: Pointer to hold pdev params |
| * Return: None |
| */ |
| static void populate_pdev_param_tlv(uint32_t *pdev_param) |
| { |
| pdev_param[wmi_pdev_param_tx_chain_mask] = WMI_PDEV_PARAM_TX_CHAIN_MASK; |
| pdev_param[wmi_pdev_param_rx_chain_mask] = WMI_PDEV_PARAM_RX_CHAIN_MASK; |
| pdev_param[wmi_pdev_param_txpower_limit2g] = |
| WMI_PDEV_PARAM_TXPOWER_LIMIT2G; |
| pdev_param[wmi_pdev_param_txpower_limit5g] = |
| WMI_PDEV_PARAM_TXPOWER_LIMIT5G; |
| pdev_param[wmi_pdev_param_txpower_scale] = WMI_PDEV_PARAM_TXPOWER_SCALE; |
| pdev_param[wmi_pdev_param_beacon_gen_mode] = |
| WMI_PDEV_PARAM_BEACON_GEN_MODE; |
| pdev_param[wmi_pdev_param_beacon_tx_mode] = |
| WMI_PDEV_PARAM_BEACON_TX_MODE; |
| pdev_param[wmi_pdev_param_resmgr_offchan_mode] = |
| WMI_PDEV_PARAM_RESMGR_OFFCHAN_MODE; |
| pdev_param[wmi_pdev_param_protection_mode] = |
| WMI_PDEV_PARAM_PROTECTION_MODE; |
| pdev_param[wmi_pdev_param_dynamic_bw] = WMI_PDEV_PARAM_DYNAMIC_BW; |
| pdev_param[wmi_pdev_param_non_agg_sw_retry_th] = |
| WMI_PDEV_PARAM_NON_AGG_SW_RETRY_TH; |
| pdev_param[wmi_pdev_param_agg_sw_retry_th] = |
| WMI_PDEV_PARAM_AGG_SW_RETRY_TH; |
| pdev_param[wmi_pdev_param_sta_kickout_th] = |
| WMI_PDEV_PARAM_STA_KICKOUT_TH; |
| pdev_param[wmi_pdev_param_ac_aggrsize_scaling] = |
| WMI_PDEV_PARAM_AC_AGGRSIZE_SCALING; |
| pdev_param[wmi_pdev_param_ltr_enable] = WMI_PDEV_PARAM_LTR_ENABLE; |
| pdev_param[wmi_pdev_param_ltr_ac_latency_be] = |
| WMI_PDEV_PARAM_LTR_AC_LATENCY_BE; |
| pdev_param[wmi_pdev_param_ltr_ac_latency_bk] = |
| WMI_PDEV_PARAM_LTR_AC_LATENCY_BK; |
| pdev_param[wmi_pdev_param_ltr_ac_latency_vi] = |
| WMI_PDEV_PARAM_LTR_AC_LATENCY_VI; |
| pdev_param[wmi_pdev_param_ltr_ac_latency_vo] = |
| WMI_PDEV_PARAM_LTR_AC_LATENCY_VO; |
| pdev_param[wmi_pdev_param_ltr_ac_latency_timeout] = |
| WMI_PDEV_PARAM_LTR_AC_LATENCY_TIMEOUT; |
| pdev_param[wmi_pdev_param_ltr_sleep_override] = |
| WMI_PDEV_PARAM_LTR_SLEEP_OVERRIDE; |
| pdev_param[wmi_pdev_param_ltr_rx_override] = |
| WMI_PDEV_PARAM_LTR_RX_OVERRIDE; |
| pdev_param[wmi_pdev_param_ltr_tx_activity_timeout] = |
| WMI_PDEV_PARAM_LTR_TX_ACTIVITY_TIMEOUT; |
| pdev_param[wmi_pdev_param_l1ss_enable] = WMI_PDEV_PARAM_L1SS_ENABLE; |
| pdev_param[wmi_pdev_param_dsleep_enable] = WMI_PDEV_PARAM_DSLEEP_ENABLE; |
| pdev_param[wmi_pdev_param_pcielp_txbuf_flush] = |
| WMI_PDEV_PARAM_PCIELP_TXBUF_FLUSH; |
| pdev_param[wmi_pdev_param_pcielp_txbuf_watermark] = |
| WMI_PDEV_PARAM_PCIELP_TXBUF_WATERMARK; |
| pdev_param[wmi_pdev_param_pcielp_txbuf_tmo_en] = |
| WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_EN; |
| pdev_param[wmi_pdev_param_pcielp_txbuf_tmo_value] = |
| WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_VALUE; |
| pdev_param[wmi_pdev_param_pdev_stats_update_period] = |
| WMI_PDEV_PARAM_PDEV_STATS_UPDATE_PERIOD; |
| pdev_param[wmi_pdev_param_vdev_stats_update_period] = |
| WMI_PDEV_PARAM_VDEV_STATS_UPDATE_PERIOD; |
| pdev_param[wmi_pdev_param_peer_stats_update_period] = |
| WMI_PDEV_PARAM_PEER_STATS_UPDATE_PERIOD; |
| pdev_param[wmi_pdev_param_bcnflt_stats_update_period] = |
| WMI_PDEV_PARAM_BCNFLT_STATS_UPDATE_PERIOD; |
| pdev_param[wmi_pdev_param_pmf_qos] = WMI_PDEV_PARAM_PMF_QOS; |
| pdev_param[wmi_pdev_param_arp_ac_override] = |
| WMI_PDEV_PARAM_ARP_AC_OVERRIDE; |
| pdev_param[wmi_pdev_param_dcs] = WMI_PDEV_PARAM_DCS; |
| pdev_param[wmi_pdev_param_ani_enable] = WMI_PDEV_PARAM_ANI_ENABLE; |
| pdev_param[wmi_pdev_param_ani_poll_period] = |
| WMI_PDEV_PARAM_ANI_POLL_PERIOD; |
| pdev_param[wmi_pdev_param_ani_listen_period] = |
| WMI_PDEV_PARAM_ANI_LISTEN_PERIOD; |
| pdev_param[wmi_pdev_param_ani_ofdm_level] = |
| WMI_PDEV_PARAM_ANI_OFDM_LEVEL; |
| pdev_param[wmi_pdev_param_ani_cck_level] = WMI_PDEV_PARAM_ANI_CCK_LEVEL; |
| pdev_param[wmi_pdev_param_dyntxchain] = WMI_PDEV_PARAM_DYNTXCHAIN; |
| pdev_param[wmi_pdev_param_proxy_sta] = WMI_PDEV_PARAM_PROXY_STA; |
| pdev_param[wmi_pdev_param_idle_ps_config] = |
| WMI_PDEV_PARAM_IDLE_PS_CONFIG; |
| pdev_param[wmi_pdev_param_power_gating_sleep] = |
| WMI_PDEV_PARAM_POWER_GATING_SLEEP; |
| pdev_param[wmi_pdev_param_rfkill_enable] = WMI_PDEV_PARAM_RFKILL_ENABLE; |
| pdev_param[wmi_pdev_param_burst_dur] = WMI_PDEV_PARAM_BURST_DUR; |
| pdev_param[wmi_pdev_param_burst_enable] = WMI_PDEV_PARAM_BURST_ENABLE; |
| pdev_param[wmi_pdev_param_hw_rfkill_config] = |
| WMI_PDEV_PARAM_HW_RFKILL_CONFIG; |
| pdev_param[wmi_pdev_param_low_power_rf_enable] = |
| WMI_PDEV_PARAM_LOW_POWER_RF_ENABLE; |
| pdev_param[wmi_pdev_param_l1ss_track] = WMI_PDEV_PARAM_L1SS_TRACK; |
| pdev_param[wmi_pdev_param_hyst_en] = WMI_PDEV_PARAM_HYST_EN; |
| pdev_param[wmi_pdev_param_power_collapse_enable] = |
| WMI_PDEV_PARAM_POWER_COLLAPSE_ENABLE; |
| pdev_param[wmi_pdev_param_led_sys_state] = WMI_PDEV_PARAM_LED_SYS_STATE; |
| pdev_param[wmi_pdev_param_led_enable] = WMI_PDEV_PARAM_LED_ENABLE; |
| pdev_param[wmi_pdev_param_audio_over_wlan_latency] = |
| WMI_PDEV_PARAM_AUDIO_OVER_WLAN_LATENCY; |
| pdev_param[wmi_pdev_param_audio_over_wlan_enable] = |
| WMI_PDEV_PARAM_AUDIO_OVER_WLAN_ENABLE; |
| pdev_param[wmi_pdev_param_whal_mib_stats_update_enable] = |
| WMI_PDEV_PARAM_WHAL_MIB_STATS_UPDATE_ENABLE; |
| pdev_param[wmi_pdev_param_vdev_rate_stats_update_period] = |
| WMI_PDEV_PARAM_VDEV_RATE_STATS_UPDATE_PERIOD; |
| pdev_param[wmi_pdev_param_cts_cbw] = WMI_PDEV_PARAM_CTS_CBW; |
| pdev_param[wmi_pdev_param_wnts_config] = WMI_PDEV_PARAM_WNTS_CONFIG; |
| pdev_param[wmi_pdev_param_adaptive_early_rx_enable] = |
| WMI_PDEV_PARAM_ADAPTIVE_EARLY_RX_ENABLE; |
| pdev_param[wmi_pdev_param_adaptive_early_rx_min_sleep_slop] = |
| WMI_PDEV_PARAM_ADAPTIVE_EARLY_RX_MIN_SLEEP_SLOP; |
| pdev_param[wmi_pdev_param_adaptive_early_rx_inc_dec_step] = |
| WMI_PDEV_PARAM_ADAPTIVE_EARLY_RX_INC_DEC_STEP; |
| pdev_param[wmi_pdev_param_early_rx_fix_sleep_slop] = |
| WMI_PDEV_PARAM_EARLY_RX_FIX_SLEEP_SLOP; |
| pdev_param[wmi_pdev_param_bmiss_based_adaptive_bto_enable] = |
| WMI_PDEV_PARAM_BMISS_BASED_ADAPTIVE_BTO_ENABLE; |
| pdev_param[wmi_pdev_param_bmiss_bto_min_bcn_timeout] = |
| WMI_PDEV_PARAM_BMISS_BTO_MIN_BCN_TIMEOUT; |
| pdev_param[wmi_pdev_param_bmiss_bto_inc_dec_step] = |
| WMI_PDEV_PARAM_BMISS_BTO_INC_DEC_STEP; |
| pdev_param[wmi_pdev_param_bto_fix_bcn_timeout] = |
| WMI_PDEV_PARAM_BTO_FIX_BCN_TIMEOUT; |
| pdev_param[wmi_pdev_param_ce_based_adaptive_bto_enable] = |
| WMI_PDEV_PARAM_CE_BASED_ADAPTIVE_BTO_ENABLE; |
| pdev_param[wmi_pdev_param_ce_bto_combo_ce_value] = |
| WMI_PDEV_PARAM_CE_BTO_COMBO_CE_VALUE; |
| pdev_param[wmi_pdev_param_tx_chain_mask_2g] = |
| WMI_PDEV_PARAM_TX_CHAIN_MASK_2G; |
| pdev_param[wmi_pdev_param_rx_chain_mask_2g] = |
| WMI_PDEV_PARAM_RX_CHAIN_MASK_2G; |
| pdev_param[wmi_pdev_param_tx_chain_mask_5g] = |
| WMI_PDEV_PARAM_TX_CHAIN_MASK_5G; |
| pdev_param[wmi_pdev_param_rx_chain_mask_5g] = |
| WMI_PDEV_PARAM_RX_CHAIN_MASK_5G; |
| pdev_param[wmi_pdev_param_tx_chain_mask_cck] = |
| WMI_PDEV_PARAM_TX_CHAIN_MASK_CCK; |
| pdev_param[wmi_pdev_param_tx_chain_mask_1ss] = |
| WMI_PDEV_PARAM_TX_CHAIN_MASK_1SS; |
| pdev_param[wmi_pdev_param_rx_filter] = WMI_PDEV_PARAM_RX_FILTER; |
| pdev_param[wmi_pdev_set_mcast_to_ucast_tid] = |
| WMI_PDEV_SET_MCAST_TO_UCAST_TID; |
| pdev_param[wmi_pdev_param_mgmt_retry_limit] = |
| WMI_PDEV_PARAM_MGMT_RETRY_LIMIT; |
| pdev_param[wmi_pdev_param_aggr_burst] = WMI_PDEV_PARAM_AGGR_BURST; |
| pdev_param[wmi_pdev_peer_sta_ps_statechg_enable] = |
| WMI_PDEV_PEER_STA_PS_STATECHG_ENABLE; |
| pdev_param[wmi_pdev_param_proxy_sta_mode] = |
| WMI_PDEV_PARAM_PROXY_STA_MODE; |
| pdev_param[wmi_pdev_param_mu_group_policy] = |
| WMI_PDEV_PARAM_MU_GROUP_POLICY; |
| pdev_param[wmi_pdev_param_noise_detection] = |
| WMI_PDEV_PARAM_NOISE_DETECTION; |
| pdev_param[wmi_pdev_param_noise_threshold] = |
| WMI_PDEV_PARAM_NOISE_THRESHOLD; |
| pdev_param[wmi_pdev_param_dpd_enable] = WMI_PDEV_PARAM_DPD_ENABLE; |
| pdev_param[wmi_pdev_param_set_mcast_bcast_echo] = |
| WMI_PDEV_PARAM_SET_MCAST_BCAST_ECHO; |
| pdev_param[wmi_pdev_param_atf_strict_sch] = |
| WMI_PDEV_PARAM_ATF_STRICT_SCH; |
| pdev_param[wmi_pdev_param_atf_sched_duration] = |
| WMI_PDEV_PARAM_ATF_SCHED_DURATION; |
| pdev_param[wmi_pdev_param_ant_plzn] = WMI_PDEV_PARAM_ANT_PLZN; |
| pdev_param[wmi_pdev_param_sensitivity_level] = |
| WMI_PDEV_PARAM_SENSITIVITY_LEVEL; |
| pdev_param[wmi_pdev_param_signed_txpower_2g] = |
| WMI_PDEV_PARAM_SIGNED_TXPOWER_2G; |
| pdev_param[wmi_pdev_param_signed_txpower_5g] = |
| WMI_PDEV_PARAM_SIGNED_TXPOWER_5G; |
| pdev_param[wmi_pdev_param_enable_per_tid_amsdu] = |
| WMI_PDEV_PARAM_ENABLE_PER_TID_AMSDU; |
| pdev_param[wmi_pdev_param_enable_per_tid_ampdu] = |
| WMI_PDEV_PARAM_ENABLE_PER_TID_AMPDU; |
| pdev_param[wmi_pdev_param_cca_threshold] = |
| WMI_PDEV_PARAM_CCA_THRESHOLD; |
| pdev_param[wmi_pdev_param_rts_fixed_rate] = |
| WMI_PDEV_PARAM_RTS_FIXED_RATE; |
| pdev_param[wmi_pdev_param_cal_period] = WMI_UNAVAILABLE_PARAM; |
| pdev_param[wmi_pdev_param_pdev_reset] = WMI_PDEV_PARAM_PDEV_RESET; |
| pdev_param[wmi_pdev_param_wapi_mbssid_offset] = |
| WMI_PDEV_PARAM_WAPI_MBSSID_OFFSET; |
| pdev_param[wmi_pdev_param_arp_srcaddr] = |
| WMI_PDEV_PARAM_ARP_DBG_SRCADDR; |
| pdev_param[wmi_pdev_param_arp_dstaddr] = |
| WMI_PDEV_PARAM_ARP_DBG_DSTADDR; |
| pdev_param[wmi_pdev_param_txpower_decr_db] = |
| WMI_PDEV_PARAM_TXPOWER_DECR_DB; |
| pdev_param[wmi_pdev_param_rx_batchmode] = WMI_UNAVAILABLE_PARAM; |
| pdev_param[wmi_pdev_param_packet_aggr_delay] = WMI_UNAVAILABLE_PARAM; |
| pdev_param[wmi_pdev_param_atf_obss_noise_sch] = |
| WMI_PDEV_PARAM_ATF_OBSS_NOISE_SCH; |
| pdev_param[wmi_pdev_param_atf_obss_noise_scaling_factor] = |
| WMI_PDEV_PARAM_ATF_OBSS_NOISE_SCALING_FACTOR; |
| pdev_param[wmi_pdev_param_cust_txpower_scale] = |
| WMI_PDEV_PARAM_CUST_TXPOWER_SCALE; |
| pdev_param[wmi_pdev_param_atf_dynamic_enable] = |
| WMI_PDEV_PARAM_ATF_DYNAMIC_ENABLE; |
| pdev_param[wmi_pdev_param_atf_ssid_group_policy] = |
| WMI_UNAVAILABLE_PARAM; |
| pdev_param[wmi_pdev_param_igmpmld_override] = |
| WMI_PDEV_PARAM_IGMPMLD_AC_OVERRIDE; |
| pdev_param[wmi_pdev_param_igmpmld_tid] = |
| WMI_PDEV_PARAM_IGMPMLD_AC_OVERRIDE; |
| pdev_param[wmi_pdev_param_antenna_gain] = WMI_PDEV_PARAM_ANTENNA_GAIN; |
| pdev_param[wmi_pdev_param_block_interbss] = |
| WMI_PDEV_PARAM_BLOCK_INTERBSS; |
| pdev_param[wmi_pdev_param_set_disable_reset_cmdid] = |
| WMI_PDEV_PARAM_SET_DISABLE_RESET_CMDID; |
| pdev_param[wmi_pdev_param_set_msdu_ttl_cmdid] = |
| WMI_PDEV_PARAM_SET_MSDU_TTL_CMDID; |
| pdev_param[wmi_pdev_param_txbf_sound_period_cmdid] = |
| WMI_PDEV_PARAM_TXBF_SOUND_PERIOD_CMDID; |
| pdev_param[wmi_pdev_param_set_burst_mode_cmdid] = |
| WMI_PDEV_PARAM_SET_BURST_MODE_CMDID; |
| pdev_param[wmi_pdev_param_en_stats] = WMI_PDEV_PARAM_EN_STATS; |
| pdev_param[wmi_pdev_param_mesh_mcast_enable] = |
| WMI_PDEV_PARAM_MESH_MCAST_ENABLE; |
| pdev_param[wmi_pdev_param_set_promisc_mode_cmdid] = |
| WMI_PDEV_PARAM_SET_PROMISC_MODE_CMDID; |
| pdev_param[wmi_pdev_param_set_ppdu_duration_cmdid] = |
| WMI_PDEV_PARAM_SET_PPDU_DURATION_CMDID; |
| pdev_param[wmi_pdev_param_remove_mcast2ucast_buffer] = |
| WMI_PDEV_PARAM_REMOVE_MCAST2UCAST_BUFFER; |
| pdev_param[wmi_pdev_param_set_mcast2ucast_buffer] = |
| WMI_PDEV_PARAM_SET_MCAST2UCAST_BUFFER; |
| pdev_param[wmi_pdev_param_set_mcast2ucast_mode] = |
| WMI_PDEV_PARAM_SET_MCAST2UCAST_MODE; |
| pdev_param[wmi_pdev_param_smart_antenna_default_antenna] = |
| WMI_PDEV_PARAM_SMART_ANTENNA_DEFAULT_ANTENNA; |
| pdev_param[wmi_pdev_param_fast_channel_reset] = |
| WMI_PDEV_PARAM_FAST_CHANNEL_RESET; |
| pdev_param[wmi_pdev_param_rx_decap_mode] = WMI_PDEV_PARAM_RX_DECAP_MODE; |
| pdev_param[wmi_pdev_param_tx_ack_timeout] = WMI_PDEV_PARAM_ACK_TIMEOUT; |
| pdev_param[wmi_pdev_param_cck_tx_enable] = WMI_PDEV_PARAM_CCK_TX_ENABLE; |
| pdev_param[wmi_pdev_param_antenna_gain_half_db] = |
| WMI_PDEV_PARAM_ANTENNA_GAIN_HALF_DB; |
| pdev_param[wmi_pdev_param_esp_indication_period] = |
| WMI_PDEV_PARAM_ESP_INDICATION_PERIOD; |
| #ifdef WLAN_RU26_SUPPORT |
| pdev_param[wmi_pdev_param_ru26_allowed] = WMI_PDEV_PARAM_RU26_ALLOWED; |
| #endif |
| } |
| |
| /** |
| * populate_vdev_param_tlv() - populates vdev params |
| * |
| * @param vdev_param: Pointer to hold vdev params |
| * Return: None |
| */ |
| static void populate_vdev_param_tlv(uint32_t *vdev_param) |
| { |
| vdev_param[wmi_vdev_param_rts_threshold] = WMI_VDEV_PARAM_RTS_THRESHOLD; |
| vdev_param[wmi_vdev_param_fragmentation_threshold] = |
| WMI_VDEV_PARAM_FRAGMENTATION_THRESHOLD; |
| vdev_param[wmi_vdev_param_beacon_interval] = |
| WMI_VDEV_PARAM_BEACON_INTERVAL; |
| vdev_param[wmi_vdev_param_listen_interval] = |
| WMI_VDEV_PARAM_LISTEN_INTERVAL; |
| vdev_param[wmi_vdev_param_multicast_rate] = |
| WMI_VDEV_PARAM_MULTICAST_RATE; |
| vdev_param[wmi_vdev_param_mgmt_tx_rate] = WMI_VDEV_PARAM_MGMT_TX_RATE; |
| vdev_param[wmi_vdev_param_slot_time] = WMI_VDEV_PARAM_SLOT_TIME; |
| vdev_param[wmi_vdev_param_preamble] = WMI_VDEV_PARAM_PREAMBLE; |
| vdev_param[wmi_vdev_param_swba_time] = WMI_VDEV_PARAM_SWBA_TIME; |
| vdev_param[wmi_vdev_stats_update_period] = WMI_VDEV_STATS_UPDATE_PERIOD; |
| vdev_param[wmi_vdev_pwrsave_ageout_time] = WMI_VDEV_PWRSAVE_AGEOUT_TIME; |
| vdev_param[wmi_vdev_host_swba_interval] = WMI_VDEV_HOST_SWBA_INTERVAL; |
| vdev_param[wmi_vdev_param_dtim_period] = WMI_VDEV_PARAM_DTIM_PERIOD; |
| vdev_param[wmi_vdev_oc_scheduler_air_time_limit] = |
| WMI_VDEV_OC_SCHEDULER_AIR_TIME_LIMIT; |
| vdev_param[wmi_vdev_param_wds] = WMI_VDEV_PARAM_WDS; |
| vdev_param[wmi_vdev_param_atim_window] = WMI_VDEV_PARAM_ATIM_WINDOW; |
| vdev_param[wmi_vdev_param_bmiss_count_max] = |
| WMI_VDEV_PARAM_BMISS_COUNT_MAX; |
| vdev_param[wmi_vdev_param_bmiss_first_bcnt] = |
| WMI_VDEV_PARAM_BMISS_FIRST_BCNT; |
| vdev_param[wmi_vdev_param_bmiss_final_bcnt] = |
| WMI_VDEV_PARAM_BMISS_FINAL_BCNT; |
| vdev_param[wmi_vdev_param_feature_wmm] = WMI_VDEV_PARAM_FEATURE_WMM; |
| vdev_param[wmi_vdev_param_chwidth] = WMI_VDEV_PARAM_CHWIDTH; |
| vdev_param[wmi_vdev_param_chextoffset] = WMI_VDEV_PARAM_CHEXTOFFSET; |
| vdev_param[wmi_vdev_param_disable_htprotection] = |
| WMI_VDEV_PARAM_DISABLE_HTPROTECTION; |
| vdev_param[wmi_vdev_param_sta_quickkickout] = |
| WMI_VDEV_PARAM_STA_QUICKKICKOUT; |
| vdev_param[wmi_vdev_param_mgmt_rate] = WMI_VDEV_PARAM_MGMT_RATE; |
| vdev_param[wmi_vdev_param_protection_mode] = |
| WMI_VDEV_PARAM_PROTECTION_MODE; |
| vdev_param[wmi_vdev_param_fixed_rate] = WMI_VDEV_PARAM_FIXED_RATE; |
| vdev_param[wmi_vdev_param_sgi] = WMI_VDEV_PARAM_SGI; |
| vdev_param[wmi_vdev_param_ldpc] = WMI_VDEV_PARAM_LDPC; |
| vdev_param[wmi_vdev_param_tx_stbc] = WMI_VDEV_PARAM_TX_STBC; |
| vdev_param[wmi_vdev_param_rx_stbc] = WMI_VDEV_PARAM_RX_STBC; |
| vdev_param[wmi_vdev_param_intra_bss_fwd] = WMI_VDEV_PARAM_INTRA_BSS_FWD; |
| vdev_param[wmi_vdev_param_def_keyid] = WMI_VDEV_PARAM_DEF_KEYID; |
| vdev_param[wmi_vdev_param_nss] = WMI_VDEV_PARAM_NSS; |
| vdev_param[wmi_vdev_param_bcast_data_rate] = |
| WMI_VDEV_PARAM_BCAST_DATA_RATE; |
| vdev_param[wmi_vdev_param_mcast_data_rate] = |
| WMI_VDEV_PARAM_MCAST_DATA_RATE; |
| vdev_param[wmi_vdev_param_mcast_indicate] = |
| WMI_VDEV_PARAM_MCAST_INDICATE; |
| vdev_param[wmi_vdev_param_dhcp_indicate] = |
| WMI_VDEV_PARAM_DHCP_INDICATE; |
| vdev_param[wmi_vdev_param_unknown_dest_indicate] = |
| WMI_VDEV_PARAM_UNKNOWN_DEST_INDICATE; |
| vdev_param[wmi_vdev_param_ap_keepalive_min_idle_inactive_time_secs] = |
| WMI_VDEV_PARAM_AP_KEEPALIVE_MIN_IDLE_INACTIVE_TIME_SECS; |
| vdev_param[wmi_vdev_param_ap_keepalive_max_idle_inactive_time_secs] = |
| WMI_VDEV_PARAM_AP_KEEPALIVE_MAX_IDLE_INACTIVE_TIME_SECS; |
| vdev_param[wmi_vdev_param_ap_keepalive_max_unresponsive_time_secs] = |
| WMI_VDEV_PARAM_AP_KEEPALIVE_MAX_UNRESPONSIVE_TIME_SECS; |
| vdev_param[wmi_vdev_param_ap_enable_nawds] = |
| WMI_VDEV_PARAM_AP_ENABLE_NAWDS; |
| vdev_param[wmi_vdev_param_enable_rtscts] = WMI_VDEV_PARAM_ENABLE_RTSCTS; |
| vdev_param[wmi_vdev_param_txbf] = WMI_VDEV_PARAM_TXBF; |
| vdev_param[wmi_vdev_param_packet_powersave] = |
| WMI_VDEV_PARAM_PACKET_POWERSAVE; |
| vdev_param[wmi_vdev_param_drop_unencry] = WMI_VDEV_PARAM_DROP_UNENCRY; |
| vdev_param[wmi_vdev_param_tx_encap_type] = WMI_VDEV_PARAM_TX_ENCAP_TYPE; |
| vdev_param[wmi_vdev_param_ap_detect_out_of_sync_sleeping_sta_time_secs] = |
| WMI_VDEV_PARAM_AP_DETECT_OUT_OF_SYNC_SLEEPING_STA_TIME_SECS; |
| vdev_param[wmi_vdev_param_early_rx_adjust_enable] = |
| WMI_VDEV_PARAM_EARLY_RX_ADJUST_ENABLE; |
| vdev_param[wmi_vdev_param_early_rx_tgt_bmiss_num] = |
| WMI_VDEV_PARAM_EARLY_RX_TGT_BMISS_NUM; |
| vdev_param[wmi_vdev_param_early_rx_bmiss_sample_cycle] = |
| WMI_VDEV_PARAM_EARLY_RX_BMISS_SAMPLE_CYCLE; |
| vdev_param[wmi_vdev_param_early_rx_slop_step] = |
| WMI_VDEV_PARAM_EARLY_RX_SLOP_STEP; |
| vdev_param[wmi_vdev_param_early_rx_init_slop] = |
| WMI_VDEV_PARAM_EARLY_RX_INIT_SLOP; |
| vdev_param[wmi_vdev_param_early_rx_adjust_pause] = |
| WMI_VDEV_PARAM_EARLY_RX_ADJUST_PAUSE; |
| vdev_param[wmi_vdev_param_tx_pwrlimit] = WMI_VDEV_PARAM_TX_PWRLIMIT; |
| vdev_param[wmi_vdev_param_snr_num_for_cal] = |
| WMI_VDEV_PARAM_SNR_NUM_FOR_CAL; |
| vdev_param[wmi_vdev_param_roam_fw_offload] = |
| WMI_VDEV_PARAM_ROAM_FW_OFFLOAD; |
| vdev_param[wmi_vdev_param_enable_rmc] = WMI_VDEV_PARAM_ENABLE_RMC; |
| vdev_param[wmi_vdev_param_ibss_max_bcn_lost_ms] = |
| WMI_VDEV_PARAM_IBSS_MAX_BCN_LOST_MS; |
| vdev_param[wmi_vdev_param_max_rate] = WMI_VDEV_PARAM_MAX_RATE; |
| vdev_param[wmi_vdev_param_early_rx_drift_sample] = |
| WMI_VDEV_PARAM_EARLY_RX_DRIFT_SAMPLE; |
| vdev_param[wmi_vdev_param_set_ibss_tx_fail_cnt_thr] = |
| WMI_VDEV_PARAM_SET_IBSS_TX_FAIL_CNT_THR; |
| vdev_param[wmi_vdev_param_ebt_resync_timeout] = |
| WMI_VDEV_PARAM_EBT_RESYNC_TIMEOUT; |
| vdev_param[wmi_vdev_param_aggr_trig_event_enable] = |
| WMI_VDEV_PARAM_AGGR_TRIG_EVENT_ENABLE; |
| vdev_param[wmi_vdev_param_is_ibss_power_save_allowed] = |
| WMI_VDEV_PARAM_IS_IBSS_POWER_SAVE_ALLOWED; |
| vdev_param[wmi_vdev_param_is_power_collapse_allowed] = |
| WMI_VDEV_PARAM_IS_POWER_COLLAPSE_ALLOWED; |
| vdev_param[wmi_vdev_param_is_awake_on_txrx_enabled] = |
| WMI_VDEV_PARAM_IS_AWAKE_ON_TXRX_ENABLED; |
| vdev_param[wmi_vdev_param_inactivity_cnt] = |
| WMI_VDEV_PARAM_INACTIVITY_CNT; |
| vdev_param[wmi_vdev_param_txsp_end_inactivity_time_ms] = |
| WMI_VDEV_PARAM_TXSP_END_INACTIVITY_TIME_MS; |
| vdev_param[wmi_vdev_param_dtim_policy] = WMI_VDEV_PARAM_DTIM_POLICY; |
| vdev_param[wmi_vdev_param_ibss_ps_warmup_time_secs] = |
| WMI_VDEV_PARAM_IBSS_PS_WARMUP_TIME_SECS; |
| vdev_param[wmi_vdev_param_ibss_ps_1rx_chain_in_atim_window_enable] = |
| WMI_VDEV_PARAM_IBSS_PS_1RX_CHAIN_IN_ATIM_WINDOW_ENABLE; |
| vdev_param[wmi_vdev_param_rx_leak_window] = |
| WMI_VDEV_PARAM_RX_LEAK_WINDOW; |
| vdev_param[wmi_vdev_param_stats_avg_factor] = |
| WMI_VDEV_PARAM_STATS_AVG_FACTOR; |
| vdev_param[wmi_vdev_param_disconnect_th] = WMI_VDEV_PARAM_DISCONNECT_TH; |
| vdev_param[wmi_vdev_param_rtscts_rate] = WMI_VDEV_PARAM_RTSCTS_RATE; |
| vdev_param[wmi_vdev_param_mcc_rtscts_protection_enable] = |
| WMI_VDEV_PARAM_MCC_RTSCTS_PROTECTION_ENABLE; |
| vdev_param[wmi_vdev_param_mcc_broadcast_probe_enable] = |
| WMI_VDEV_PARAM_MCC_BROADCAST_PROBE_ENABLE; |
| vdev_param[wmi_vdev_param_mgmt_tx_power] = WMI_VDEV_PARAM_MGMT_TX_POWER; |
| vdev_param[wmi_vdev_param_beacon_rate] = WMI_VDEV_PARAM_BEACON_RATE; |
| vdev_param[wmi_vdev_param_rx_decap_type] = WMI_VDEV_PARAM_RX_DECAP_TYPE; |
| vdev_param[wmi_vdev_param_he_dcm_enable] = WMI_VDEV_PARAM_HE_DCM; |
| vdev_param[wmi_vdev_param_he_range_ext_enable] = |
| WMI_VDEV_PARAM_HE_RANGE_EXT; |
| vdev_param[wmi_vdev_param_he_bss_color] = WMI_VDEV_PARAM_BSS_COLOR; |
| vdev_param[wmi_vdev_param_set_hemu_mode] = WMI_VDEV_PARAM_SET_HEMU_MODE; |
| vdev_param[wmi_vdev_param_set_he_sounding_mode] |
| = WMI_VDEV_PARAM_SET_HE_SOUNDING_MODE; |
| vdev_param[wmi_vdev_param_set_heop] = WMI_VDEV_PARAM_HEOPS_0_31; |
| vdev_param[wmi_vdev_param_sensor_ap] = WMI_VDEV_PARAM_SENSOR_AP; |
| vdev_param[wmi_vdev_param_dtim_enable_cts] = |
| WMI_VDEV_PARAM_DTIM_ENABLE_CTS; |
| vdev_param[wmi_vdev_param_atf_ssid_sched_policy] = |
| WMI_VDEV_PARAM_ATF_SSID_SCHED_POLICY; |
| vdev_param[wmi_vdev_param_disable_dyn_bw_rts] = |
| WMI_VDEV_PARAM_DISABLE_DYN_BW_RTS; |
| vdev_param[wmi_vdev_param_mcast2ucast_set] = |
| WMI_VDEV_PARAM_MCAST2UCAST_SET; |
| vdev_param[wmi_vdev_param_rc_num_retries] = |
| WMI_VDEV_PARAM_RC_NUM_RETRIES; |
| vdev_param[wmi_vdev_param_cabq_maxdur] = WMI_VDEV_PARAM_CABQ_MAXDUR; |
| vdev_param[wmi_vdev_param_mfptest_set] = WMI_VDEV_PARAM_MFPTEST_SET; |
| vdev_param[wmi_vdev_param_rts_fixed_rate] = |
| WMI_VDEV_PARAM_RTS_FIXED_RATE; |
| vdev_param[wmi_vdev_param_vht_sgimask] = WMI_VDEV_PARAM_VHT_SGIMASK; |
| vdev_param[wmi_vdev_param_vht80_ratemask] = |
| WMI_VDEV_PARAM_VHT80_RATEMASK; |
| vdev_param[wmi_vdev_param_proxy_sta] = WMI_VDEV_PARAM_PROXY_STA; |
| vdev_param[wmi_vdev_param_bw_nss_ratemask] = |
| WMI_VDEV_PARAM_BW_NSS_RATEMASK; |
| vdev_param[wmi_vdev_param_set_he_ltf] = |
| WMI_VDEV_PARAM_HE_LTF; |
| vdev_param[wmi_vdev_param_disable_cabq] = |
| WMI_VDEV_PARAM_DISABLE_CABQ; |
| vdev_param[wmi_vdev_param_rate_dropdown_bmap] = |
| WMI_VDEV_PARAM_RATE_DROPDOWN_BMAP; |
| vdev_param[wmi_vdev_param_set_ba_mode] = |
| WMI_VDEV_PARAM_BA_MODE; |
| vdev_param[wmi_vdev_param_capabilities] = |
| WMI_VDEV_PARAM_CAPABILITIES; |
| vdev_param[wmi_vdev_param_autorate_misc_cfg] = |
| WMI_VDEV_PARAM_AUTORATE_MISC_CFG; |
| } |
| #endif |
| |
| /** |
| * populate_target_defines_tlv() - Populate target defines and params |
| * @wmi_handle: pointer to wmi handle |
| * |
| * Return: None |
| */ |
| #ifndef CONFIG_MCL |
| static void populate_target_defines_tlv(struct wmi_unified *wmi_handle) |
| { |
| populate_pdev_param_tlv(wmi_handle->pdev_param); |
| populate_vdev_param_tlv(wmi_handle->vdev_param); |
| } |
| #else |
| static void populate_target_defines_tlv(struct wmi_unified *wmi_handle) |
| { } |
| #endif |
| |
| /** |
| * wmi_ocb_ut_attach() - Attach OCB test framework |
| * @wmi_handle: wmi handle |
| * |
| * Return: None |
| */ |
| #ifdef WLAN_OCB_UT |
| void wmi_ocb_ut_attach(struct wmi_unified *wmi_handle); |
| #else |
| static inline void wmi_ocb_ut_attach(struct wmi_unified *wmi_handle) |
| { |
| return; |
| } |
| #endif |
| |
| /** |
| * wmi_tlv_attach() - Attach TLV APIs |
| * |
| * Return: None |
| */ |
| void wmi_tlv_attach(wmi_unified_t wmi_handle) |
| { |
| wmi_handle->ops = &tlv_ops; |
| wmi_ocb_ut_attach(wmi_handle); |
| wmi_handle->soc->svc_ids = &multi_svc_ids[0]; |
| #ifdef WMI_INTERFACE_EVENT_LOGGING |
| /* Skip saving WMI_CMD_HDR and TLV HDR */ |
| wmi_handle->log_info.buf_offset_command = 8; |
| /* WMI_CMD_HDR is already stripped, skip saving TLV HDR */ |
| wmi_handle->log_info.buf_offset_event = 4; |
| #endif |
| populate_tlv_events_id(wmi_handle->wmi_events); |
| populate_tlv_service(wmi_handle->services); |
| populate_target_defines_tlv(wmi_handle); |
| wmi_twt_attach_tlv(wmi_handle); |
| wmi_extscan_attach_tlv(wmi_handle); |
| } |
| qdf_export_symbol(wmi_tlv_attach); |
| |
| /** |
| * wmi_tlv_init() - Initialize WMI TLV module by registering TLV attach routine |
| * |
| * Return: None |
| */ |
| void wmi_tlv_init(void) |
| { |
| wmi_unified_register_module(WMI_TLV_TARGET, &wmi_tlv_attach); |
| } |