123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518 |
- /*
- * Copyright (c) 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 <wlan_defs.h>
- #include "target_if.h"
- #include "wma.h"
- #include "wlan_ocb_ucfg_api.h"
- #include "wlan_ocb_main.h"
- void wmi_ocb_ut_attach(struct wmi_unified *wmi_handle);
- static inline struct wlan_ocb_rx_ops *
- target_if_ocb_get_rx_ops(struct wlan_objmgr_psoc *psoc)
- {
- struct wlan_objmgr_pdev *pdev;
- struct ocb_pdev_obj *pdev_obj;
- pdev = wlan_objmgr_get_pdev_by_id(psoc, 0,
- WLAN_OCB_SB_ID);
- pdev_obj = (struct ocb_pdev_obj *)
- wlan_objmgr_pdev_get_comp_private_obj(pdev,
- WLAN_UMAC_COMP_OCB);
- return &pdev_obj->ocb_rxops;
- }
- /**
- * fake_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 fake_vdev_create_cmd_tlv(wmi_unified_t wmi_handle,
- uint8_t macaddr[IEEE80211_ADDR_LEN],
- struct vdev_create_params *param)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_vdev_delete_cmd_tlv(wmi_unified_t wmi_handle,
- uint8_t if_id)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_ocb_set_utc_time_cmd_tlv() - 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 fake_ocb_set_utc_time_cmd_tlv(wmi_unified_t wmi_handle,
- struct ocb_utc_param *utc)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_ocb_get_tsf_timer_cmd_tlv(wmi_unified_t wmi_handle,
- uint8_t vdev_id)
- {
- QDF_STATUS status;
- struct wlan_objmgr_psoc *psoc;
- struct wlan_ocb_rx_ops *ocb_rx_ops;
- struct ocb_get_tsf_timer_response response;
- ol_scn_t scn = (ol_scn_t) wmi_handle->scn_handle;
- WMI_LOGP("%s : called", __func__);
- psoc = target_if_get_psoc_from_scn_hdl(scn);
- if (!psoc) {
- WMI_LOGP("null psoc");
- return -EINVAL;
- }
- response.vdev_id = vdev_id;
- response.timer_high = 0x1234;
- response.timer_low = 0x5678;
- ocb_rx_ops = target_if_ocb_get_rx_ops(psoc);
- if (ocb_rx_ops->ocb_tsf_timer) {
- status = ocb_rx_ops->ocb_tsf_timer(psoc, &response);
- if (status != QDF_STATUS_SUCCESS) {
- WMI_LOGP("ocb_tsf_timer failed.");
- return -EINVAL;
- }
- } else {
- WMI_LOGP("No ocb_tsf_timer callback");
- return -EINVAL;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_dcc_clear_stats_cmd_tlv(wmi_unified_t wmi_handle,
- uint32_t vdev_id, uint32_t dcc_stats_bitmap)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- wmi_dcc_ndl_stats_per_channel chan1_info[2] = {
- [0] = {.chan_info = 5860,
- .tx_power_datarate = 23 | (10 << 8),
- .carrier_sense_est_comm_range = 107 | (198 << 13),
- .dcc_stats = 78 | (56 << 8) | (345 << 16),
- .packet_stats = 1278 | (789 << 14),
- .channel_busy_time = 1389,
- },
- [1] = {.chan_info = 5880,
- .tx_power_datarate = 53 | (17 << 8),
- .carrier_sense_est_comm_range = 137 | (198 << 13),
- .dcc_stats = 78 | (66 << 8) | (245 << 16),
- .packet_stats = 1278 | (889 << 14),
- .channel_busy_time = 2389,
- },
- };
- /**
- * fake_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 fake_dcc_get_stats_cmd_tlv(wmi_unified_t wmi_handle,
- struct ocb_dcc_get_stats_param *get_stats_param)
- {
- QDF_STATUS status;
- struct wlan_objmgr_psoc *psoc;
- struct wlan_ocb_rx_ops *ocb_rx_ops;
- ol_scn_t scn = (ol_scn_t) wmi_handle->scn_handle;
- struct ocb_dcc_get_stats_response *response;
- WMI_LOGP("%s : called", __func__);
- psoc = target_if_get_psoc_from_scn_hdl(scn);
- if (!psoc) {
- WMI_LOGP("null psoc");
- return -EINVAL;
- }
- response = qdf_mem_malloc(sizeof(*response) + 2 *
- sizeof(wmi_dcc_ndl_stats_per_channel));
- response->num_channels = 2;
- response->channel_stats_array_len = 2 *
- sizeof(wmi_dcc_ndl_stats_per_channel);
- response->vdev_id = get_stats_param->vdev_id;
- response->channel_stats_array = (uint8_t *)response + sizeof(*response);
- qdf_mem_copy(response->channel_stats_array,
- &chan1_info,
- 2 * sizeof(wmi_dcc_ndl_stats_per_channel));
- WMI_LOGP("channel1 freq %d, channel2 freq %d", chan1_info[0].chan_info,
- chan1_info[1].chan_info);
- ocb_rx_ops = target_if_ocb_get_rx_ops(psoc);
- if (ocb_rx_ops->ocb_dcc_stats_indicate) {
- status = ocb_rx_ops->ocb_dcc_stats_indicate(psoc,
- response, true);
- if (status != QDF_STATUS_SUCCESS) {
- WMI_LOGP("dcc_stats_indicate failed.");
- status = -EINVAL;
- } else {
- status = 0;
- }
- } else {
- WMI_LOGP("No dcc_stats_indicate callback");
- status = -EINVAL;
- }
- qdf_mem_free(response);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_dcc_update_ndl_cmd_tlv(wmi_unified_t wmi_handle,
- struct ocb_dcc_update_ndl_param *update_ndl_param)
- {
- QDF_STATUS status;
- struct wlan_objmgr_psoc *psoc;
- struct wlan_ocb_rx_ops *ocb_rx_ops;
- ol_scn_t scn = (ol_scn_t) wmi_handle->scn_handle;
- struct ocb_dcc_update_ndl_response *resp;
- WMI_LOGP("%s : called", __func__);
- /* Allocate and populate the response */
- resp = qdf_mem_malloc(sizeof(*resp));
- if (!resp) {
- WMI_LOGP("%s:Error allocating memory for the response.",
- __func__);
- return -ENOMEM;
- }
- resp->vdev_id = update_ndl_param->vdev_id;
- resp->status = 0;
- psoc = target_if_get_psoc_from_scn_hdl(scn);
- if (!psoc) {
- WMI_LOGP("null psoc");
- return -EINVAL;
- }
- ocb_rx_ops = target_if_ocb_get_rx_ops(psoc);
- if (ocb_rx_ops->ocb_dcc_ndl_update) {
- status = ocb_rx_ops->ocb_dcc_ndl_update(psoc, resp);
- if (status != QDF_STATUS_SUCCESS) {
- WMI_LOGP("dcc_ndl_update failed.");
- status = -EINVAL;
- } else {
- status = 0;
- }
- } else {
- WMI_LOGP("No dcc_ndl_update callback");
- status = -EINVAL;
- }
- qdf_mem_free(resp);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_ocb_set_config_cmd_tlv(wmi_unified_t wmi_handle,
- struct ocb_config *config)
- {
- u32 i;
- QDF_STATUS status;
- struct wlan_objmgr_psoc *psoc;
- struct wlan_ocb_rx_ops *ocb_rx_ops;
- ol_scn_t scn = (ol_scn_t) wmi_handle->scn_handle;
- WMI_LOGP("%s : called", __func__);
- WMI_LOGI("%s: vdev_id=%d, channel_count=%d, schedule_size=%d, flag=%x",
- __func__, config->vdev_id, config->channel_count,
- config->schedule_size, config->flags);
- for (i = 0; i < config->channel_count; i++) {
- WMI_LOGI("%s: channel info for channel %d"
- " chan_freq=%d, bandwidth=%d, " QDF_MAC_ADDRESS_STR
- " max_pwr=%d, min_pwr=%d, reg_pwr=%d, antenna_max=%d, "
- "flags=%d", __func__, i, config->channels[i].chan_freq,
- config->channels[i].bandwidth,
- QDF_MAC_ADDR_ARRAY(
- config->channels[i].mac_address.bytes),
- config->channels[i].max_pwr,
- config->channels[i].min_pwr,
- config->channels[i].reg_pwr,
- config->channels[i].antenna_max,
- config->channels[i].flags);
- }
- for (i = 0; i < config->schedule_size; i++) {
- WMI_LOGI("%s: schedule info for channel %d: "
- "chan_fre=%d, total_duration=%d, guard_intreval=%d",
- __func__, i, config->schedule[i].chan_freq,
- config->schedule[i].total_duration,
- config->schedule[i].guard_interval);
- }
- psoc = target_if_get_psoc_from_scn_hdl(scn);
- if (!psoc) {
- WMI_LOGP("null psoc");
- return -EINVAL;
- }
- ocb_rx_ops = target_if_ocb_get_rx_ops(psoc);
- if (ocb_rx_ops->ocb_set_config_status) {
- status = ocb_rx_ops->ocb_set_config_status(psoc, 0);
- if (status != QDF_STATUS_SUCCESS) {
- WMI_LOGP("ocb_set_config_status failed.");
- return -EINVAL;
- }
- } else {
- WMI_LOGP("No ocb_set_config_status callback");
- return -EINVAL;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_ocb_stop_timing_advert_cmd_tlv(wmi_unified_t wmi_handle,
- struct ocb_timing_advert_param *timing_advert)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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
- fake_ocb_start_timing_advert_cmd_tlv(wmi_unified_t wmi_handle,
- struct ocb_timing_advert_param *timing_advert)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_peer_create_cmd_tlv(wmi_unified_t wmi,
- struct peer_create_params *param)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_peer_delete_cmd_tlv(wmi_unified_t wmi,
- uint8_t peer_addr[IEEE80211_ADDR_LEN],
- uint8_t vdev_id)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_vdev_start_cmd_tlv() - send vdev start request to fw
- * @wmi_handle: wmi handle
- * @req: vdev start params
- *
- * Return: QDF status
- */
- static QDF_STATUS fake_vdev_start_cmd_tlv(wmi_unified_t wmi_handle,
- struct vdev_start_params *req)
- {
- tp_wma_handle wma = (tp_wma_handle) wmi_handle->scn_handle;
- WMI_LOGP("%s : called", __func__);
- WMI_LOGI("%s: vdev_id %d freq %d chanmode %d ch_info is_dfs %d "
- "beacon interval %d dtim %d center_chan %d center_freq2 %d "
- "max_txpow: 0x%x "
- "Tx SS %d, Rx SS %d, ldpc_rx: %d, cac %d, regd %d, HE ops: %d",
- __func__, (int)req->vdev_id, req->channel.mhz,
- req->channel.phy_mode,
- (int)req->channel.dfs_set, req->beacon_intval, req->dtim_period,
- req->channel.cfreq1, req->channel.cfreq2,
- req->channel.maxregpower,
- req->preferred_tx_streams, req->preferred_rx_streams,
- (int)req->ldpc_rx_enabled, req->cac_duration_ms,
- req->regdomain, req->he_ops);
- wma_remove_vdev_req(wma, req->vdev_id,
- WMA_TARGET_REQ_TYPE_VDEV_START);
- #ifndef CONFIG_VDEV_SM
- wma_vdev_set_mlme_state(wma, req->vdev_id,
- WLAN_VDEV_S_RUN);
- #endif
- ucfg_ocb_config_channel(wma->pdev);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_vdev_down_cmd_tlv(wmi_unified_t wmi, uint8_t vdev_id)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_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 fake_vdev_set_param_cmd_tlv(wmi_unified_t wmi_handle,
- struct vdev_set_params *param)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * fake_set_enable_disable_mcc_adaptive_scheduler_cmd_tlv() -
- * faked API to 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 fake_set_enable_disable_mcc_adaptive_scheduler_cmd_tlv(
- wmi_unified_t wmi_handle, uint32_t mcc_adaptive_scheduler,
- uint32_t pdev_id)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- /*
- * fake_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 fake_process_set_ie_info_cmd_tlv(wmi_unified_t wmi_handle,
- struct vdev_ie_info_param *ie_info)
- {
- WMI_LOGP("%s : called", __func__);
- return QDF_STATUS_SUCCESS;
- }
- void wmi_ocb_ut_attach(struct wmi_unified *wmi_handle)
- {
- struct wmi_ops *wmi_ops;
- if (!wmi_handle) {
- WMI_LOGP("%s: null wmi handle", __func__);
- return;
- }
- wmi_ops = wmi_handle->ops;
- wmi_ops->send_vdev_create_cmd = fake_vdev_create_cmd_tlv;
- wmi_ops->send_vdev_delete_cmd = fake_vdev_delete_cmd_tlv;
- wmi_ops->send_vdev_down_cmd = fake_vdev_down_cmd_tlv;
- wmi_ops->send_vdev_start_cmd = fake_vdev_start_cmd_tlv;
- wmi_ops->send_peer_create_cmd = fake_peer_create_cmd_tlv;
- wmi_ops->send_peer_delete_cmd = fake_peer_delete_cmd_tlv;
- wmi_ops->send_vdev_set_param_cmd = fake_vdev_set_param_cmd_tlv;
- wmi_ops->send_ocb_set_utc_time_cmd = fake_ocb_set_utc_time_cmd_tlv;
- wmi_ops->send_ocb_get_tsf_timer_cmd = fake_ocb_get_tsf_timer_cmd_tlv;
- wmi_ops->send_dcc_clear_stats_cmd = fake_dcc_clear_stats_cmd_tlv;
- wmi_ops->send_dcc_get_stats_cmd = fake_dcc_get_stats_cmd_tlv;
- wmi_ops->send_dcc_update_ndl_cmd = fake_dcc_update_ndl_cmd_tlv;
- wmi_ops->send_ocb_set_config_cmd = fake_ocb_set_config_cmd_tlv;
- wmi_ops->send_ocb_stop_timing_advert_cmd =
- fake_ocb_stop_timing_advert_cmd_tlv;
- wmi_ops->send_ocb_start_timing_advert_cmd =
- fake_ocb_start_timing_advert_cmd_tlv;
- wmi_ops->send_set_enable_disable_mcc_adaptive_scheduler_cmd =
- fake_set_enable_disable_mcc_adaptive_scheduler_cmd_tlv;
- wmi_ops->send_process_set_ie_info_cmd =
- fake_process_set_ie_info_cmd_tlv;
- }
|