qcacmn: TDLS component: os_if layer

Implement TDLS related cfg80211 interface functions

Change-Id: I3ef38f670902ff486cad7c55473ce5805473aa17
CRs-Fixed: 2011330

os_if/linux/tdls/inc/wlan_cfg80211_tdls.h

@@ -0,0 +1,126 @@
+/*
+ * Copyright (c) 2017 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: declares driver functions interfacing with linux kernel
+ */
+
+#ifndef _WLAN_CFG80211_TDLS_H_
+#define _WLAN_CFG80211_TDLS_H_
+
+#include <linux/version.h>
+#include <linux/netdevice.h>
+#include <linux/completion.h>
+#include <net/cfg80211.h>
+#include <qca_vendor.h>
+#include <wlan_tdls_public_structs.h>
+#include <qdf_list.h>
+#include <qdf_types.h>
+#include <wlan_tdls_ucfg_api.h>
+
+/**
+ * struct osif_tdls_vdev - OS tdls vdev private structure
+ * @tdls_add_peer_comp: Completion to add tdls peer
+ * @tdls_del_peer_comp: Completion to delete tdls peer
+ * @tdls_mgmt_comp: Completion to send tdls mgmt packets
+ * @tdls_link_establish_req_comp: Completion to establish link, sync to
+ * send establish params to firmware, not used today.
+ * @tdls_add_peer_status: Peer status after add peer
+ * @mgmt_tx_completion_status: Tdls mgmt frames TX completion status code
+ */
+struct osif_tdls_vdev {
+	struct completion tdls_add_peer_comp;
+	struct completion tdls_del_peer_comp;
+	struct completion tdls_mgmt_comp;
+	struct completion tdls_link_establish_req_comp;
+	QDF_STATUS tdls_add_peer_status;
+	uint32_t mgmt_tx_completion_status;
+};
+
+/**
+ * wlan_cfg80211_tdls_priv_init() - API to initialize tdls os private
+ * @osif_priv: vdev os private
+ *
+ * API to initialize tdls os private
+ *
+ * Return: QDF_STATUS
+ */
+QDF_STATUS wlan_cfg80211_tdls_priv_init(struct vdev_osif_priv *osif_priv);
+
+/**
+ * wlan_cfg80211_tdls_priv_deinit() - API to deinitialize tdls os private
+ * @osif_priv: vdev os private
+ *
+ * API to deinitialize tdls os private
+ *
+ * Return: None
+ */
+void wlan_cfg80211_tdls_priv_deinit(struct vdev_osif_priv *osif_priv);
+
+/**
+ * wlan_cfg80211_tdls_add_peer() - process cfg80211 add TDLS peer request
+ * @pdev: pdev object
+ * @dev: Pointer to net device
+ * @mac: MAC address for TDLS peer
+ *
+ * Return: 0 for success; negative errno otherwise
+ */
+int wlan_cfg80211_tdls_add_peer(struct wlan_objmgr_pdev *pdev,
+				struct net_device *dev, const uint8_t *mac);
+
+/**
+ * wlan_cfg80211_tdls_update_peer() - process cfg80211 update TDLS peer request
+ * @pdev: pdev object
+ * @dev: Pointer to net device
+ * @mac: MAC address for TDLS peer
+ * @params: Pointer to station parameters
+ *
+ * Return: 0 for success; negative errno otherwise
+ */
+int wlan_cfg80211_tdls_update_peer(struct wlan_objmgr_pdev *pdev,
+				   struct net_device *dev,
+				   const uint8_t *mac,
+				   struct station_parameters *params);
+/**
+ * wlan_cfg80211_tdls_oper() - process cfg80211 operation on an TDLS peer
+ * @pdev: pdev object
+ * @dev: net device
+ * @peer: MAC address of the TDLS peer
+ * @oper: cfg80211 TDLS operation
+ *
+ * Return: 0 on success; negative errno otherwise
+ */
+int wlan_cfg80211_tdls_oper(struct wlan_objmgr_pdev *pdev,
+			    struct net_device *dev,
+			    const uint8_t *peer,
+			    enum nl80211_tdls_operation oper);
+
+/**
+ * wlan_cfg80211_tdls_event_callback() - callback for tdls module
+ * @userdata: user data
+ * @type: request callback type
+ * @param: passed parameter
+ *
+ * This is used by TDLS to sync with os interface
+ *
+ * Return: None
+ */
+void wlan_cfg80211_tdls_event_callback(void *userdata,
+				       enum tdls_event_type type,
+				       struct tdls_osif_indication *param);
+#endif

os_if/linux/tdls/src/wlan_cfg80211_tdls.c

@@ -0,0 +1,526 @@
+/*
+ * Copyright (c) 2017 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: defines driver functions interfacing with linux kernel
+ */
+
+#include <qdf_list.h>
+#include <qdf_status.h>
+#include <linux/wireless.h>
+#include <linux/netdevice.h>
+#include <net/cfg80211.h>
+#include <wlan_cfg80211.h>
+#include <wlan_cfg80211_tdls.h>
+#include <wlan_osif_priv.h>
+#include <wlan_tdls_public_structs.h>
+#include <wlan_tdls_ucfg_api.h>
+#include <qdf_mem.h>
+#include <wlan_utility.h>
+#include <wlan_reg_services_api.h>
+
+#define MAX_CHANNEL (NUM_24GHZ_CHANNELS + NUM_5GHZ_CHANNELS)
+
+QDF_STATUS wlan_cfg80211_tdls_priv_init(struct vdev_osif_priv *osif_priv)
+{
+	struct osif_tdls_vdev *tdls_priv;
+
+	cfg80211_debug("initialize tdls os if layer private structure");
+	tdls_priv = qdf_mem_malloc(sizeof(*tdls_priv));
+	if (!tdls_priv) {
+		cfg80211_err("failed to allocate memory for tdls_priv");
+		return QDF_STATUS_E_NOMEM;
+	}
+	init_completion(&tdls_priv->tdls_add_peer_comp);
+	init_completion(&tdls_priv->tdls_del_peer_comp);
+	init_completion(&tdls_priv->tdls_mgmt_comp);
+	init_completion(&tdls_priv->tdls_link_establish_req_comp);
+
+	osif_priv->osif_tdls = tdls_priv;
+
+	return QDF_STATUS_SUCCESS;
+}
+
+void wlan_cfg80211_tdls_priv_deinit(struct vdev_osif_priv *osif_priv)
+{
+	cfg80211_debug("deinitialize tdls os if layer private structure");
+	if (osif_priv->osif_tdls)
+		qdf_mem_free(osif_priv->osif_tdls);
+	osif_priv->osif_tdls = NULL;
+}
+
+int wlan_cfg80211_tdls_add_peer(struct wlan_objmgr_pdev *pdev,
+				struct net_device *dev, const uint8_t *mac)
+{
+	struct wlan_objmgr_vdev *vdev;
+	struct tdls_add_peer_params *add_peer_req;
+	int status;
+	struct vdev_osif_priv *osif_priv;
+	struct osif_tdls_vdev *tdls_priv;
+	unsigned long rc;
+
+	cfg80211_debug("Add TDLS peer " QDF_MAC_ADDRESS_STR,
+		       QDF_MAC_ADDR_ARRAY(mac));
+	vdev = wlan_objmgr_get_vdev_by_macaddr_from_pdev(pdev, dev->dev_addr,
+							 WLAN_OSIF_ID);
+	if (vdev == NULL) {
+		cfg80211_err("vdev object is NULL");
+		return -EIO;
+	}
+
+	add_peer_req = qdf_mem_malloc(sizeof(*add_peer_req));
+	if (!add_peer_req) {
+		wlan_objmgr_vdev_release_ref(vdev, WLAN_OSIF_ID);
+		cfg80211_err("Failed to allocate tdls add peer request mem");
+		return -EINVAL;
+	}
+
+	wlan_vdev_obj_lock(vdev);
+	osif_priv = wlan_vdev_get_ospriv(vdev);
+	tdls_priv = osif_priv->osif_tdls;
+
+	add_peer_req->vdev_id = wlan_vdev_get_id(vdev);
+	wlan_vdev_obj_unlock(vdev);
+
+	qdf_mem_copy(add_peer_req->peer_addr, mac, QDF_MAC_ADDR_SIZE);
+
+	reinit_completion(&tdls_priv->tdls_add_peer_comp);
+	status = ucfg_tdls_add_peer(vdev, add_peer_req);
+	if (QDF_IS_STATUS_ERROR(status)) {
+		cfg80211_err("ucfg_tdls_add_peer returned err %d", status);
+		status = -EIO;
+		goto error;
+	}
+
+	rc = wait_for_completion_timeout(
+	    &tdls_priv->tdls_add_peer_comp,
+	    msecs_to_jiffies(WAIT_TIME_TDLS_ADD_STA));
+	if (!rc) {
+		cfg80211_err("timeout for tdls add peer indication %ld", rc);
+		status = -EPERM;
+		goto error;
+	}
+
+	if (QDF_IS_STATUS_ERROR(tdls_priv->tdls_add_peer_status)) {
+		cfg80211_err("tdls add peer failed, status:%d",
+			     tdls_priv->tdls_add_peer_status);
+		status = -EPERM;
+	}
+error:
+	qdf_mem_free(add_peer_req);
+	wlan_objmgr_vdev_release_ref(vdev, WLAN_OSIF_ID);
+	return status;
+}
+
+static bool
+is_duplicate_channel(uint8_t *arr, int index, uint8_t match)
+{
+	int i;
+
+	for (i = 0; i < index; i++) {
+		if (arr[i] == match)
+			return true;
+	}
+	return false;
+}
+
+static void
+tdls_calc_channels_from_staparams(struct tdls_update_peer_params *req_info,
+				  struct station_parameters *params)
+{
+	int i = 0, j = 0, k = 0, no_of_channels = 0;
+	int num_unique_channels;
+	int next;
+	uint8_t *dest_chans;
+	const uint8_t *src_chans;
+
+	dest_chans = req_info->supported_channels;
+	src_chans = params->supported_channels;
+
+	/* Convert (first channel , number of channels) tuple to
+	 * the total list of channels. This goes with the assumption
+	 * that if the first channel is < 14, then the next channels
+	 * are an incremental of 1 else an incremental of 4 till the number
+	 * of channels.
+	 */
+	for (i = 0; i < params->supported_channels_len &&
+	     j < WLAN_MAC_MAX_SUPP_CHANNELS; i += 2) {
+		int wifi_chan_index;
+
+		if (!is_duplicate_channel(dest_chans, j, src_chans[i]))
+			dest_chans[j] = src_chans[i];
+		else
+			continue;
+
+		wifi_chan_index = ((dest_chans[j] <= WLAN_CHANNEL_14) ? 1 : 4);
+		no_of_channels = src_chans[i + 1];
+
+		cfg80211_debug("i:%d,j:%d,k:%d,[%d]:%d,index:%d,chans_num: %d",
+			       i, j, k, j,
+			       dest_chans[j],
+			       wifi_chan_index,
+			       no_of_channels);
+
+		for (k = 1; k <= no_of_channels &&
+		     j < WLAN_MAC_MAX_SUPP_CHANNELS - 1; k++) {
+			next = dest_chans[j] + wifi_chan_index;
+
+			if (!is_duplicate_channel(dest_chans, j + 1, next))
+				dest_chans[j + 1] = next;
+			else
+				continue;
+
+			cfg80211_debug("i: %d, j: %d, k: %d, [%d]: %d",
+				       i, j, k, j + 1, dest_chans[j + 1]);
+			j += 1;
+		}
+	}
+	num_unique_channels = j + 1;
+	cfg80211_debug("Unique Channel List: supported_channels ");
+	for (i = 0; i < num_unique_channels; i++)
+		cfg80211_debug("[%d]: %d,", i, dest_chans[i]);
+
+	if (MAX_CHANNEL < num_unique_channels)
+		num_unique_channels = MAX_CHANNEL;
+	req_info->supported_channels_len = num_unique_channels;
+	cfg80211_debug("After removing duplcates supported_channels_len: %d",
+		       req_info->supported_channels_len);
+}
+
+static void
+wlan_cfg80211_tdls_extract_params(struct tdls_update_peer_params *req_info,
+				  struct station_parameters *params)
+{
+	int i;
+
+	cfg80211_debug("sta cap %d, uapsd_queue %d, max_sp %d",
+		       params->capability,
+		       params->uapsd_queues, params->max_sp);
+
+	if (!req_info) {
+		cfg80211_err("reg_info is NULL");
+		return;
+	}
+	req_info->capability = params->capability;
+	req_info->uapsd_queues = params->uapsd_queues;
+	req_info->max_sp = params->max_sp;
+
+	if (params->supported_channels_len)
+		tdls_calc_channels_from_staparams(req_info, params);
+
+	qdf_mem_copy(req_info->supported_oper_classes,
+		     params->supported_oper_classes,
+		     params->supported_oper_classes_len);
+	req_info->supported_oper_classes_len =
+		params->supported_oper_classes_len;
+
+	if (params->ext_capab_len)
+		qdf_mem_copy(req_info->extn_capability, params->ext_capab,
+			     sizeof(req_info->extn_capability));
+
+	if (params->ht_capa) {
+		req_info->htcap_present = 1;
+		qdf_mem_copy(&req_info->ht_cap, params->ht_capa,
+			     sizeof(struct htcap_cmn_ie));
+	}
+
+	req_info->supported_rates_len = params->supported_rates_len;
+
+	/* Note : The Maximum sizeof supported_rates sent by the Supplicant is
+	 * 32. The supported_rates array , for all the structures propogating
+	 * till Add Sta to the firmware has to be modified , if the supplicant
+	 * (ieee80211) is modified to send more rates.
+	 */
+
+	/* To avoid Data Currption , set to max length to SIR_MAC_MAX_SUPP_RATES
+	 */
+	if (req_info->supported_rates_len > WLAN_MAC_MAX_SUPP_RATES)
+		req_info->supported_rates_len = WLAN_MAC_MAX_SUPP_RATES;
+
+	if (req_info->supported_rates_len) {
+		qdf_mem_copy(req_info->supported_rates,
+			     params->supported_rates,
+			     req_info->supported_rates_len);
+		cfg80211_debug("Supported Rates with Length %d",
+			       req_info->supported_rates_len);
+
+		for (i = 0; i < req_info->supported_rates_len; i++)
+			cfg80211_debug("[%d]: %0x", i,
+				       req_info->supported_rates[i]);
+	}
+
+	if (params->vht_capa) {
+		req_info->vhtcap_present = 1;
+		qdf_mem_copy(&req_info->vht_cap, params->vht_capa,
+			     sizeof(struct vhtcap));
+	}
+
+	if (params->ht_capa || params->vht_capa ||
+	    (params->sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
+		req_info->is_qos_wmm_sta = true;
+}
+
+int wlan_cfg80211_tdls_update_peer(struct wlan_objmgr_pdev *pdev,
+				   struct net_device *dev,
+				   const uint8_t *mac,
+				   struct station_parameters *params)
+{
+	struct wlan_objmgr_vdev *vdev;
+	struct tdls_update_peer_params *req_info;
+	int status;
+	struct vdev_osif_priv *osif_priv;
+	struct osif_tdls_vdev *tdls_priv;
+	unsigned long rc;
+
+	cfg80211_debug("Update TDLS peer " QDF_MAC_ADDRESS_STR,
+		       QDF_MAC_ADDR_ARRAY(mac));
+	vdev = wlan_objmgr_get_vdev_by_macaddr_from_pdev(pdev, dev->dev_addr,
+							 WLAN_OSIF_ID);
+	if (vdev == NULL) {
+		cfg80211_err("vdev object is NULL");
+		return -EIO;
+	}
+
+	req_info = qdf_mem_malloc(sizeof(*req_info));
+	if (!req_info) {
+		wlan_objmgr_vdev_release_ref(vdev, WLAN_OSIF_ID);
+		cfg80211_err("Failed to allocate tdls add peer request mem");
+		return -EINVAL;
+	}
+	wlan_cfg80211_tdls_extract_params(req_info, params);
+
+	wlan_vdev_obj_lock(vdev);
+	osif_priv = wlan_vdev_get_ospriv(vdev);
+	tdls_priv = osif_priv->osif_tdls;
+
+	req_info->vdev_id = wlan_vdev_get_id(vdev);
+	wlan_vdev_obj_unlock(vdev);
+	qdf_mem_copy(req_info->peer_addr, mac, QDF_MAC_ADDR_SIZE);
+
+	reinit_completion(&tdls_priv->tdls_add_peer_comp);
+	status = ucfg_tdls_update_peer(vdev, req_info);
+	if (QDF_IS_STATUS_ERROR(status)) {
+		cfg80211_err("ucfg_tdls_update_peer returned err %d", status);
+		status = -EIO;
+		goto error;
+	}
+
+	rc = wait_for_completion_timeout(
+		&tdls_priv->tdls_add_peer_comp,
+		msecs_to_jiffies(WAIT_TIME_TDLS_ADD_STA));
+	if (!rc) {
+		cfg80211_err("timeout for tdls update peer indication %ld", rc);
+		status = -EPERM;
+		goto error;
+	}
+
+	if (QDF_IS_STATUS_ERROR(tdls_priv->tdls_add_peer_status)) {
+		cfg80211_err("tdls update peer failed, status:%d",
+			     tdls_priv->tdls_add_peer_status);
+		status = -EPERM;
+	}
+error:
+	qdf_mem_free(req_info);
+	wlan_objmgr_vdev_release_ref(vdev, WLAN_OSIF_ID);
+	return status;
+}
+
+static char *tdls_oper_to_str(enum nl80211_tdls_operation oper)
+{
+	switch (oper) {
+	case NL80211_TDLS_ENABLE_LINK:
+		return "TDLS_ENABLE_LINK";
+	case NL80211_TDLS_DISABLE_LINK:
+		return "TDLS_DISABLE_LINK";
+	case NL80211_TDLS_TEARDOWN:
+		return "TDLS_TEARDOWN";
+	case NL80211_TDLS_SETUP:
+		return "TDLS_SETUP";
+	default:
+		return "UNKNOWN:ERR";
+	}
+}
+
+static enum tdls_command_type tdls_oper_to_cmd(enum nl80211_tdls_operation oper)
+{
+	if (oper == NL80211_TDLS_ENABLE_LINK)
+		return TDLS_CMD_ENABLE_LINK;
+	else if (oper == NL80211_TDLS_DISABLE_LINK)
+		return TDLS_CMD_DISABLE_LINK;
+	else if (oper == NL80211_TDLS_TEARDOWN)
+		return TDLS_CMD_REMOVE_FORCE_PEER;
+	else if (oper == NL80211_TDLS_SETUP)
+		return TDLS_CMD_CONFIG_FORCE_PEER;
+	else
+		return 0;
+}
+
+int wlan_cfg80211_tdls_oper(struct wlan_objmgr_pdev *pdev,
+			    struct net_device *dev,
+			    const uint8_t *peer,
+			    enum nl80211_tdls_operation oper)
+{
+	struct wlan_objmgr_vdev *vdev;
+	struct vdev_osif_priv *osif_priv;
+	struct osif_tdls_vdev *tdls_priv;
+	int status;
+	unsigned long rc;
+	enum tdls_command_type cmd;
+
+	if (NL80211_TDLS_DISCOVERY_REQ == oper) {
+		cfg80211_warn(
+			"We don't support in-driver setup/teardown/discovery");
+		return -ENOTSUPP;
+	}
+
+	vdev = wlan_objmgr_get_vdev_by_macaddr_from_pdev(pdev,
+							 dev->dev_addr,
+							 WLAN_OSIF_ID);
+	if (vdev == NULL) {
+		cfg80211_err("vdev object is NULL");
+		return -EIO;
+	}
+
+	cfg80211_debug("%s start", tdls_oper_to_str(oper));
+	cmd = tdls_oper_to_cmd(oper);
+	switch (oper) {
+	case NL80211_TDLS_ENABLE_LINK:
+	case NL80211_TDLS_TEARDOWN:
+	case NL80211_TDLS_SETUP:
+		status = ucfg_tdls_oper(vdev, peer, cmd);
+		if (QDF_IS_STATUS_ERROR(status)) {
+			cfg80211_err("%s fail %d",
+				     tdls_oper_to_str(oper), status);
+			status = -EIO;
+			goto error;
+		}
+		break;
+	case NL80211_TDLS_DISABLE_LINK:
+		wlan_vdev_obj_lock(vdev);
+		osif_priv = wlan_vdev_get_ospriv(vdev);
+		tdls_priv = osif_priv->osif_tdls;
+		wlan_vdev_obj_unlock(vdev);
+		reinit_completion(&tdls_priv->tdls_del_peer_comp);
+		status = ucfg_tdls_oper(vdev, peer, cmd);
+		if (QDF_IS_STATUS_ERROR(status)) {
+			cfg80211_err("ucfg_tdls_disable_link fail %d", status);
+			status = -EIO;
+			goto error;
+		}
+
+		rc = wait_for_completion_timeout(
+			&tdls_priv->tdls_del_peer_comp,
+			msecs_to_jiffies(WAIT_TIME_TDLS_DEL_STA));
+		if (!rc) {
+			cfg80211_err("timeout for tdls disable link %ld", rc);
+			status = -EPERM;
+		}
+		break;
+	default:
+		cfg80211_err("unsupported event %d", oper);
+		status = -ENOTSUPP;
+	}
+
+error:
+	wlan_objmgr_vdev_release_ref(vdev, WLAN_OSIF_ID);
+
+	return status;
+}
+
+static void
+wlan_cfg80211_tdls_indicate_discovery(struct tdls_osif_indication *ind)
+{
+	struct vdev_osif_priv *osif_vdev;
+
+	wlan_vdev_obj_lock(ind->vdev);
+	osif_vdev = wlan_vdev_get_ospriv(ind->vdev);
+	wlan_vdev_obj_unlock(ind->vdev);
+
+	cfg80211_info("Implicit TDLS, request Send Discovery request");
+	cfg80211_tdls_oper_request(osif_vdev->wdev->netdev,
+				   ind->peer_mac, NL80211_TDLS_DISCOVERY_REQ,
+				   false, GFP_KERNEL);
+}
+
+static void
+wlan_cfg80211_tdls_indicate_setup(struct tdls_osif_indication *ind)
+{
+	struct vdev_osif_priv *osif_vdev;
+
+	wlan_vdev_obj_lock(ind->vdev);
+	osif_vdev = wlan_vdev_get_ospriv(ind->vdev);
+	wlan_vdev_obj_unlock(ind->vdev);
+
+	cfg80211_info("Indication to request TDLS setup");
+	cfg80211_tdls_oper_request(osif_vdev->wdev->netdev,
+				   ind->peer_mac, NL80211_TDLS_SETUP, false,
+				   GFP_KERNEL);
+}
+
+static void
+wlan_cfg80211_tdls_indicate_teardown(struct tdls_osif_indication *ind)
+{
+	struct vdev_osif_priv *osif_vdev;
+
+	wlan_vdev_obj_lock(ind->vdev);
+	osif_vdev = wlan_vdev_get_ospriv(ind->vdev);
+	wlan_vdev_obj_unlock(ind->vdev);
+
+	cfg80211_info("Teardown reason %d", ind->reason);
+	cfg80211_tdls_oper_request(osif_vdev->wdev->netdev,
+				   ind->peer_mac, NL80211_TDLS_TEARDOWN,
+				   ind->reason, GFP_KERNEL);
+}
+
+void wlan_cfg80211_tdls_event_callback(void *user_data,
+				       enum tdls_event_type type,
+				       struct tdls_osif_indication *ind)
+{
+	struct vdev_osif_priv *osif_vdev;
+	struct osif_tdls_vdev *tdls_priv;
+
+	if (!ind || !ind->vdev) {
+		cfg80211_err("ind: %p", ind);
+		return;
+	}
+	wlan_vdev_obj_lock(ind->vdev);
+	osif_vdev = wlan_vdev_get_ospriv(ind->vdev);
+	tdls_priv = osif_vdev->osif_tdls;
+	wlan_vdev_obj_unlock(ind->vdev);
+
+	switch (type) {
+	case TDLS_EVENT_ADD_PEER:
+		tdls_priv->tdls_add_peer_status = ind->status;
+		complete(&tdls_priv->tdls_add_peer_comp);
+		break;
+	case TDLS_EVENT_DEL_PEER:
+		complete(&tdls_priv->tdls_del_peer_comp);
+		break;
+	case TDLS_EVENT_DISCOVERY_REQ:
+		wlan_cfg80211_tdls_indicate_discovery(ind);
+		break;
+	case TDLS_EVENT_TEARDOWN_REQ:
+		wlan_cfg80211_tdls_indicate_teardown(ind);
+		break;
+	case TDLS_EVENT_SETUP_REQ:
+		wlan_cfg80211_tdls_indicate_setup(ind);
+		break;
+	default:
+		break;
+	}
+}

os_if/linux/wlan_osif_priv.h

@@ -21,6 +21,7 @@
 #define _WLAN_OSIF_PRIV_H_
 
 struct osif_scan_pdev;
+struct osif_tdls_vdev;
 
 /**
  *  struct pdev_osif_priv - OS private structure
@@ -42,6 +43,7 @@ struct pdev_osif_priv {
 struct vdev_osif_priv {
 	struct wireless_dev *wdev;
 	void *legacy_osif_priv;
+	struct osif_tdls_vdev *osif_tdls;
 };
 
 #endif