android_kernel_samsung_sm8650-modules/wmi_unified_ocb_ut.c

/*
 * 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;
}