qcacld-3.0: Send async event to userspace for NAN concurrency

As part of Spatial Reuse, host has to send SR Suspend and resume
events based on concurrency which is not sent in case of NAN
concurrency.

Fix is to send SR Suspend in case NAN comes up and any STA that
supports SR is already present because SR is not supported in
case of NAN concurrency. Similarly during NAN disable check
if any other vdev apart from NAN is sharing mac with STA that
supports SR and SR support on same mac is disabled then don't
send SR resume event as there is already a concurrent vdev that
will take care of SR Suspend event otherwise send SR Resume event.

Change-Id: I56a9b455dd0166bc3997f8306992e46da759e992
CRs-Fixed: 3339713

components/nan/core/inc/nan_public_structs.h

@@ -796,6 +796,8 @@ struct nan_datapath_host_event {
  * @delete_peers_by_addr: LIM callback for deleting peer by MAC address
  * @update_ndi_conn: WMA callback to update NDI's connection info
  * @nan_concurrency_update: Callback to handle nan concurrency
+ * @nan_sr_concurrency_update: Callback to handle nan SR(Spatial Reuse)
+ * concurrency
  */
 struct nan_callbacks {
 	/* callback to os_if layer from umac */
@@ -822,6 +824,9 @@ struct nan_callbacks {
 				      struct nan_datapath_channel_info
 								    *chan_info);
 	void (*nan_concurrency_update)(void);
+#ifdef WLAN_FEATURE_SR
+	void (*nan_sr_concurrency_update)(struct nan_event_params *nan_evt);
+#endif
 };
 
 /**

components/nan/dispatcher/src/nan_ucfg_api.c

@@ -594,6 +594,21 @@ static void ucfg_nan_request_process_cb(void *cookie)
 	}
 }
 
+#ifdef WLAN_FEATURE_SR
+static void
+nan_register_sr_concurrency_callback(struct nan_psoc_priv_obj *psoc_obj,
+				     struct nan_callbacks *cb_obj)
+{
+	psoc_obj->cb_obj.nan_sr_concurrency_update =
+				cb_obj->nan_sr_concurrency_update;
+}
+#else
+static inline void
+nan_register_sr_concurrency_callback(struct nan_psoc_priv_obj *psoc_obj,
+				     struct nan_callbacks *cb_obj)
+{}
+#endif
+
 int ucfg_nan_register_hdd_callbacks(struct wlan_objmgr_psoc *psoc,
 				    struct nan_callbacks *cb_obj)
 {
@@ -624,7 +639,7 @@ int ucfg_nan_register_hdd_callbacks(struct wlan_objmgr_psoc *psoc,
 				ucfg_nan_request_process_cb;
 	psoc_obj->cb_obj.nan_concurrency_update =
 				cb_obj->nan_concurrency_update;
-
+	nan_register_sr_concurrency_callback(psoc_obj, cb_obj);
 	return 0;
 }
 

core/hdd/inc/wlan_hdd_nan.h

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2014-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. 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
@@ -50,6 +51,15 @@ int wlan_hdd_cfg80211_nan_ext_request(struct wiphy *wiphy,
 				      const void *data,
 				      int data_len);
 
+#ifdef WLAN_FEATURE_SR
+/**
+ * hdd_nan_sr_concurrency_update() - NAN Spatial Reuse concurrency
+ * @nan_evt: nan event params
+ *
+ * Return: None
+ */
+void hdd_nan_sr_concurrency_update(struct nan_event_params *nan_evt);
+#endif
 #define FEATURE_NAN_VENDOR_COMMANDS					\
 	{                                                               \
 		.info.vendor_id = QCA_NL80211_VENDOR_ID,                \
@@ -71,6 +81,7 @@ int wlan_hdd_cfg80211_nan_ext_request(struct wiphy *wiphy,
 		vendor_command_policy(vendor_attr_policy,		\
 				      QCA_WLAN_VENDOR_ATTR_NDP_PARAMS_MAX) \
 	},
+
 #else /* WLAN_FEATURE_NAN */
 #define FEATURE_NAN_VENDOR_COMMANDS
 

core/hdd/src/wlan_hdd_he.c

@@ -674,6 +674,7 @@ static int __wlan_hdd_cfg80211_sr_operations(struct wiphy *wiphy,
 	uint8_t srg_min_pd_offset = 0, srg_max_pd_offset = 0;
 	uint32_t nl_buf_len;
 	int ret;
+	uint32_t conc_vdev_id;
 	struct hdd_context *hdd_ctx = wiphy_priv(wiphy);
 	struct hdd_adapter *adapter = WLAN_HDD_GET_PRIV_PTR(wdev->netdev);
 	struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_SR_MAX + 1];
@@ -701,7 +702,16 @@ static int __wlan_hdd_cfg80211_sr_operations(struct wiphy *wiphy,
 		hdd_err("station is not connected to AP that supports SR");
 		return -EPERM;
 	}
-
+	policy_mgr_get_mac_id_by_session_id(hdd_ctx->psoc, adapter->vdev_id,
+					    &mac_id);
+	conc_vdev_id = policy_mgr_get_conc_vdev_on_same_mac(hdd_ctx->psoc,
+							    adapter->vdev_id,
+							    mac_id);
+	if (conc_vdev_id != WLAN_INVALID_VDEV_ID &&
+	    !policy_mgr_sr_same_mac_conc_enabled(hdd_ctx->psoc)) {
+		hdd_err("don't allow SR in SCC/MCC");
+		return -EPERM;
+	}
 	/**
 	 * Reject command if SR concurrency is not allowed and
 	 * only STA mode is set in ini to enable SR.

core/hdd/src/wlan_hdd_main.c

@@ -3647,6 +3647,15 @@ static void hdd_register_policy_manager_callback(
 #endif
 
 #ifdef WLAN_FEATURE_NAN
+#ifdef WLAN_FEATURE_SR
+static void hdd_register_sr_concurrency_cb(struct nan_callbacks *cb_obj)
+{
+	cb_obj->nan_sr_concurrency_update = hdd_nan_sr_concurrency_update;
+}
+#else
+static void hdd_register_sr_concurrency_cb(struct nan_callbacks *cb_obj)
+{}
+#endif
 static void hdd_nan_register_callbacks(struct hdd_context *hdd_ctx)
 {
 	struct nan_callbacks cb_obj = {0};
@@ -3663,6 +3672,7 @@ static void hdd_nan_register_callbacks(struct hdd_context *hdd_ctx)
 	cb_obj.peer_departed_ind = hdd_ndp_peer_departed_handler;
 
 	cb_obj.nan_concurrency_update = hdd_nan_concurrency_update;
+	hdd_register_sr_concurrency_cb(&cb_obj);
 
 	os_if_nan_register_hdd_callbacks(hdd_ctx->psoc, &cb_obj);
 }

core/hdd/src/wlan_hdd_nan.c

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. 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
@@ -34,6 +35,10 @@
 #include <qca_vendor.h>
 #include "cfg_nan_api.h"
 #include "os_if_nan.h"
+#include "../../core/src/nan_main_i.h"
+#include "spatial_reuse_api.h"
+#include "wlan_nan_api.h"
+#include "spatial_reuse_ucfg_api.h"
 
 /**
  * wlan_hdd_nan_is_supported() - HDD NAN support query function
@@ -131,3 +136,108 @@ void hdd_nan_concurrency_update(void)
 	wlan_twt_concurrency_update(hdd_ctx);
 	hdd_exit();
 }
+
+#ifdef WLAN_FEATURE_NAN
+#ifdef WLAN_FEATURE_SR
+void hdd_nan_sr_concurrency_update(struct nan_event_params *nan_evt)
+{
+	struct wlan_objmgr_vdev *sta_vdev = NULL;
+	uint32_t conc_vdev_id = WLAN_INVALID_VDEV_ID;
+	uint8_t sr_ctrl;
+	bool is_sr_enabled = false;
+	uint32_t sta_vdev_id = WLAN_INVALID_VDEV_ID;
+	uint8_t sta_cnt, i;
+	uint32_t conn_count;
+	uint8_t non_srg_max_pd_offset = 0;
+	uint8_t vdev_id_list[MAX_NUMBER_OF_CONC_CONNECTIONS] = {
+							WLAN_INVALID_VDEV_ID};
+	struct nan_psoc_priv_obj *psoc_obj =
+				nan_get_psoc_priv_obj(nan_evt->psoc);
+	struct connection_info info[MAX_NUMBER_OF_CONC_CONNECTIONS] = {0};
+	uint8_t mac_id;
+	QDF_STATUS status;
+
+	if (!psoc_obj) {
+		nan_err("nan psoc priv object is NULL");
+		return;
+	}
+	conn_count = policy_mgr_get_connection_info(nan_evt->psoc, info);
+	if (!conn_count)
+		return;
+	sta_cnt = policy_mgr_get_mode_specific_conn_info(nan_evt->psoc, NULL,
+							 vdev_id_list,
+							 PM_STA_MODE);
+	/*
+	 * Get all active sta vdevs. STA + STA SR concurrency is not supported
+	 * so break whenever a first sta with SR enabled is found.
+	 */
+	for (i = 0; i < sta_cnt; i++) {
+		if (vdev_id_list[i] != WLAN_INVALID_VDEV_ID) {
+			sta_vdev = wlan_objmgr_get_vdev_by_id_from_psoc(
+						    nan_evt->psoc,
+						    vdev_id_list[i],
+						    WLAN_OSIF_ID);
+			if (!sta_vdev) {
+				nan_err("sta vdev invalid for vdev id %d",
+					vdev_id_list[i]);
+				continue;
+			}
+			ucfg_spatial_reuse_get_sr_config(
+					sta_vdev, &sr_ctrl,
+					&non_srg_max_pd_offset, &is_sr_enabled);
+			if (is_sr_enabled) {
+				sta_vdev_id = vdev_id_list[i];
+				break;
+			}
+			wlan_objmgr_vdev_release_ref(sta_vdev, WLAN_OSIF_ID);
+		}
+	}
+	if (sta_cnt && sta_vdev &&
+	    (!(sr_ctrl & NON_SRG_PD_SR_DISALLOWED) ||
+	    (sr_ctrl & SRG_INFO_PRESENT)) &&
+	     is_sr_enabled) {
+		if (nan_evt->evt_type == nan_event_id_enable_rsp) {
+			wlan_vdev_mlme_set_sr_disable_due_conc(
+					sta_vdev, true);
+			wlan_spatial_reuse_osif_event(
+						sta_vdev, SR_OPERATION_SUSPEND,
+						SR_REASON_CODE_CONCURRENCY);
+		}
+		if (nan_evt->evt_type == nan_event_id_disable_ind) {
+			if (conn_count > 2) {
+				status =
+				policy_mgr_get_mac_id_by_session_id(
+					nan_evt->psoc, sta_vdev_id,
+					&mac_id);
+				if (QDF_IS_STATUS_ERROR(status)) {
+					hdd_err("get mac id failed");
+					goto exit;
+				}
+				conc_vdev_id =
+				policy_mgr_get_conc_vdev_on_same_mac(
+					nan_evt->psoc, sta_vdev_id,
+					mac_id);
+				/*
+				 * Don't enable SR, if concurrent vdev is not
+				 * NAN and SR concurrency on same mac is not
+				 * allowed.
+				 */
+				if (conc_vdev_id != WLAN_INVALID_VDEV_ID &&
+				    !policy_mgr_sr_same_mac_conc_enabled(
+				    nan_evt->psoc)) {
+					hdd_debug("don't enable SR in SCC/MCC");
+					goto exit;
+				}
+			}
+			wlan_vdev_mlme_set_sr_disable_due_conc(sta_vdev, false);
+			wlan_spatial_reuse_osif_event(
+						sta_vdev, SR_OPERATION_RESUME,
+						SR_REASON_CODE_CONCURRENCY);
+		}
+	}
+exit:
+	if (sta_vdev)
+		wlan_objmgr_vdev_release_ref(sta_vdev, WLAN_OSIF_ID);
+}
+#endif
+#endif

os_if/nan/src/os_if_nan.c

@@ -2570,6 +2570,37 @@ failure:
 	kfree_skb(vendor_event);
 }
 
+/**
+ * os_if_nan_handle_sr_nan_concurrency() - Handle NAN concurrency for Spatial
+ * Reuse
+ * @nan_evt: NAN Event parameters
+ *
+ * Module calls callback to send SR event to userspace.
+ *
+ * Return: none
+ */
+#ifdef WLAN_FEATURE_SR
+static void
+os_if_nan_handle_sr_nan_concurrency(struct nan_event_params *nan_evt) {
+	void (*nan_sr_conc_callback)(struct nan_event_params *nan_evt);
+	struct nan_psoc_priv_obj *psoc_obj =
+				nan_get_psoc_priv_obj(nan_evt->psoc);
+
+	if (!psoc_obj) {
+		nan_err("nan psoc priv object is NULL");
+		return;
+	}
+
+	nan_sr_conc_callback = psoc_obj->cb_obj.nan_sr_concurrency_update;
+	if (nan_sr_conc_callback)
+		nan_sr_conc_callback(nan_evt);
+}
+#else
+static void
+os_if_nan_handle_sr_nan_concurrency(struct nan_event_params *nan_evt)
+{}
+#endif
+
 /**
  * os_if_nan_discovery_event_handler() - NAN Discovery Interface event handler
  * @nan_evt: NAN Event parameters
@@ -2593,6 +2624,8 @@ static void os_if_nan_discovery_event_handler(struct nan_event_params *nan_evt)
 		osif_err("null pdev");
 		return;
 	}
+	os_if_nan_handle_sr_nan_concurrency(nan_evt);
+
 	os_priv = wlan_pdev_get_ospriv(pdev);
 
 	vendor_event =