qcacmn: Add dcs component

Add dcs component to implement interference detection algorithm
and dynamic channel selection frequency control.

Change-Id: Ia201d77e77feb9de3aff03d6e389d4891dde118e
CRs-Fixed: 2594837

target_if/dcs/inc/target_if_dcs.h

@@ -0,0 +1,70 @@
+/*
+ * Copyright (c) 2020, The Linux Foundation. All rights reserved.
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+/**
+ * DOC: target_if_dcs.h
+ *
+ * This header file provide declarations required for Rx and Tx events from
+ * firmware
+ */
+
+#ifndef __TARGET_IF_DCS_H__
+#define __TARGET_IF_DCS_H__
+
+#include <target_if.h>
+#include <wlan_lmac_if_def.h>
+
+/**
+ * target_if_dcs_get_rx_ops() - get rx ops
+ * @tx_ops: pointer to target_if tx ops
+ *
+ * API to retrieve the dcs rx ops from the psoc context
+ *
+ * Return: pointer to rx ops
+ */
+static inline struct wlan_target_if_dcs_rx_ops *
+target_if_dcs_get_rx_ops(struct wlan_objmgr_psoc *psoc)
+{
+	return &psoc->soc_cb.rx_ops.dcs_rx_ops;
+}
+
+/**
+ * target_if_dcs_get_tx_ops() - get tx ops
+ * @tx_ops: pointer to target_if tx ops
+ *
+ * API to retrieve the dcs tx ops from the psoc context
+ *
+ * Return: pointer to tx ops
+ */
+static inline struct wlan_target_if_dcs_tx_ops *
+target_if_dcs_get_tx_ops(struct wlan_objmgr_psoc *psoc)
+{
+	return &psoc->soc_cb.tx_ops.dcs_tx_ops;
+}
+
+/**
+ * target_if_dcs_register_tx_ops() - register dcs target_if tx ops functions
+ * @tx_ops: pointer to target_if tx ops
+ *
+ * API to register dcs tx ops
+ *
+ * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
+ */
+QDF_STATUS
+target_if_dcs_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops);
+
+#endif /* __TARGET_IF_DCS_H__ */
+

target_if/dcs/src/target_if_dcs.c

@@ -0,0 +1,197 @@
+/*
+ * Copyright (c) 2020, The Linux Foundation. All rights reserved.
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+/**
+ * DOC: target_if_dcs.c
+ *
+ * This file provide definition for APIs registered through lmac Tx Ops
+ */
+
+#include <wmi_unified_api.h>
+#include <wmi_unified_priv.h>
+#include <wmi_unified_dcs_api.h>
+#include <init_deinit_lmac.h>
+#include "wlan_dcs_tgt_api.h"
+#include "target_if_dcs.h"
+
+/**
+ * target_if_dcs_interference_event_handler() - function to handle dcs event
+ * from firmware.
+ * @scn: scn handle
+ * @data: data buffer for event
+ * @datalen: data length
+ *
+ * Return: status of operation.
+ */
+static int target_if_dcs_interference_event_handler(ol_scn_t scn,
+						    uint8_t *data,
+						    uint32_t datalen)
+{
+	QDF_STATUS status;
+	struct dcs_stats_event ev;
+	struct wlan_objmgr_psoc *psoc;
+	struct wmi_unified *wmi_handle;
+	struct wlan_target_if_dcs_rx_ops *rx_ops;
+
+	if (!scn || !data) {
+		target_if_err("scn: 0x%pK, data: 0x%pK", scn, data);
+		return -EINVAL;
+	}
+	psoc = target_if_get_psoc_from_scn_hdl(scn);
+	if (!psoc) {
+		target_if_err("null psoc");
+		return -EINVAL;
+	}
+
+	rx_ops = target_if_dcs_get_rx_ops(psoc);
+	if (!rx_ops || !rx_ops->process_dcs_event) {
+		target_if_err("callback not registered");
+		return -EINVAL;
+	}
+
+	wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
+	if (!wmi_handle) {
+		target_if_err("wmi_handle is null");
+		return -EINVAL;
+	}
+
+	if (wmi_extract_dcs_interference_type(wmi_handle, data,
+					      &ev.dcs_param) !=
+						QDF_STATUS_SUCCESS) {
+		target_if_err("Unable to extract dcs interference type");
+		return -EINVAL;
+	}
+
+	if (wmi_extract_dcs_im_tgt_stats(wmi_handle, data, &ev.wlan_stat) !=
+							QDF_STATUS_SUCCESS) {
+		target_if_err("Unable to extract WLAN IM stats");
+		return -EINVAL;
+	}
+
+	status = rx_ops->process_dcs_event(psoc, &ev);
+
+	return qdf_status_to_os_return(status);
+}
+
+static QDF_STATUS
+target_if_dcs_register_event_handler(struct wlan_objmgr_psoc *psoc)
+{
+	int ret_val;
+	struct wmi_unified *wmi_handle;
+
+	if (!psoc) {
+		target_if_err("PSOC is NULL!");
+		return QDF_STATUS_E_NULL_VALUE;
+	}
+
+	wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
+	if (!wmi_handle) {
+		target_if_err("wmi_handle is null");
+		return QDF_STATUS_E_INVAL;
+	}
+
+	ret_val = wmi_unified_register_event_handler(
+			wmi_handle,
+			wmi_dcs_interference_event_id,
+			target_if_dcs_interference_event_handler,
+			WMI_RX_WORK_CTX);
+	if (ret_val)
+		target_if_err("Failed to register dcs interference event cb");
+
+	return qdf_status_from_os_return(ret_val);
+}
+
+static QDF_STATUS
+target_if_dcs_unregister_event_handler(struct wlan_objmgr_psoc *psoc)
+{
+	struct wmi_unified *wmi_handle;
+
+	if (!psoc) {
+		target_if_err("PSOC is NULL!");
+		return QDF_STATUS_E_INVAL;
+	}
+
+	wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
+	if (!wmi_handle) {
+		target_if_err("wmi_handle is null");
+		return QDF_STATUS_E_INVAL;
+	}
+	wmi_unified_unregister_event_handler(wmi_handle,
+					     wmi_dcs_interference_event_id);
+
+	return QDF_STATUS_SUCCESS;
+}
+
+/**
+ * target_if_dcs_cmd_send() - Send WMI command for dcs requests
+ * @psoc: psoc pointer
+ * @pdev_id: pdev_id
+ * @is_target_pdev_id: pdev_id is target pdev_id or not
+ * @dcs_enable: dcs enable or not
+ *
+ * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
+ */
+static QDF_STATUS
+target_if_dcs_cmd_send(struct wlan_objmgr_psoc *psoc, uint32_t pdev_id,
+		       bool is_target_pdev_id, uint32_t dcs_enable)
+{
+	QDF_STATUS ret;
+	struct wmi_unified *wmi_handle;
+
+	if (!psoc) {
+		target_if_err("null psoc");
+		return QDF_STATUS_E_FAILURE;
+	}
+
+	wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
+	if (!wmi_handle) {
+		target_if_err("null handle");
+		return QDF_STATUS_E_FAILURE;
+	}
+
+	ret = wmi_send_dcs_pdev_param(wmi_handle, pdev_id,
+				      is_target_pdev_id, dcs_enable);
+	if (QDF_IS_STATUS_ERROR(ret))
+		target_if_err("wmi dcs cmd send failed, ret: %d", ret);
+
+	return ret;
+}
+
+QDF_STATUS
+target_if_dcs_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)
+{
+	struct wlan_target_if_dcs_tx_ops *dcs_tx_ops;
+
+	if (!tx_ops) {
+		target_if_err("lmac tx ops is NULL!");
+		return QDF_STATUS_E_INVAL;
+	}
+
+	dcs_tx_ops = &tx_ops->dcs_tx_ops;
+	if (!dcs_tx_ops) {
+		target_if_err("lmac tx ops is NULL!");
+		return QDF_STATUS_E_FAILURE;
+	}
+
+	dcs_tx_ops->dcs_attach =
+		target_if_dcs_register_event_handler;
+	dcs_tx_ops->dcs_detach =
+		target_if_dcs_unregister_event_handler;
+	dcs_tx_ops->dcs_cmd_send = target_if_dcs_cmd_send;
+
+	return QDF_STATUS_SUCCESS;
+}
+