qcacld-3.0: Add ini to disable mcs13

Add ini "disable_mcs13_support" to disable mcs13 to when SAP working
on 80p80MHZ/160MHZ/320MHZ and mcs12_13 supported.

Change-Id: Iff7043cc422cbe00fa771fe5fad9ad992d6deaf5
CRs-Fixed: 3062196

components/mlme/dispatcher/inc/cfg_mlme_sap.h

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2021 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
@@ -722,6 +723,29 @@
 					1, \
 					"Enable/Disable fils discovery for SAP")
 
+/*
+ * <ini>
+ * disable_mcs13_support - Disable mcs13 support.
+ * @Min: 0
+ * @Max: 1
+ * @Default: 1
+ *
+ * This ini is used to disable mcs13 if SAP works on 80p80MHZ/160MHZ/320MHZ
+ * nd he_mcs_12_13_support enabled..
+ *
+ * Related: he_mcs_12_13_support
+ *
+ * Supported Feature: Concurrency
+ *
+ * Usage: Internal
+ *
+ * </ini>
+ */
+#define CFG_DISABLE_MCS13_SUPPORT CFG_INI_BOOL( \
+			"disable_mcs13_support", \
+			0, \
+			"mcs13 support")
+
 #define CFG_SAP_ALL \
 	CFG_SAP_SAE \
 	CFG(CFG_AP_ENABLE_RANDOM_BSSID) \
@@ -755,6 +779,7 @@
 	CFG(CFG_GO_FORCE_11N_FOR_11AC) \
 	CFG(CFG_GO_11AC_OVERRIDE) \
 	CFG(CFG_IS_SAP_BCAST_DEAUTH_ENABLED) \
-	CFG(CFG_6G_SAP_FILS_DISCOVERY_ENABLED)
+	CFG(CFG_6G_SAP_FILS_DISCOVERY_ENABLED) \
+	CFG(CFG_DISABLE_MCS13_SUPPORT)
 
 #endif /* __CFG_MLME_SAP_H */

core/sap/src/sap_fsm.c

@@ -1350,6 +1350,112 @@ QDF_STATUS sap_clear_session_param(mac_handle_t mac_handle,
 	return QDF_STATUS_SUCCESS;
 }
 
+#ifdef WLAN_FEATURE_11AX
+static uint16_t he_mcs_12_13_support(void)
+{
+	struct mac_context *mac_ctx;
+
+	mac_ctx = sap_get_mac_context();
+	if (!mac_ctx) {
+		sap_err("Invalid MAC context");
+		return 0;
+	}
+
+	return mac_ctx->mlme_cfg->he_caps.he_mcs_12_13_supp_5g;
+}
+#else
+static inline uint16_t he_mcs_12_13_support(void)
+{
+	return 0;
+}
+#endif
+
+#ifdef WLAN_FEATURE_11BE
+static bool is_mcs13_ch_width(enum phy_ch_width ch_width)
+{
+	if ((ch_width == CH_WIDTH_320MHZ) ||
+	    (ch_width == CH_WIDTH_160MHZ) ||
+	    (ch_width == CH_WIDTH_80P80MHZ))
+		return true;
+
+	return false;
+}
+#else
+static bool is_mcs13_ch_width(enum phy_ch_width ch_width)
+{
+	if ((ch_width == CH_WIDTH_160MHZ) ||
+	    (ch_width == CH_WIDTH_80P80MHZ))
+		return true;
+
+	return false;
+}
+#endif
+
+/**
+ * sap_update_mcs_rate() - Update SAP MCS rate
+ * @sap_ctx: pointer to sap Context
+ * @is_start: Start or stop SAP
+ *
+ * Return: QDF_STATUS
+ */
+static QDF_STATUS
+sap_update_mcs_rate(struct sap_context *sap_ctx, bool is_start)
+{
+	uint32_t default_mcs[] = {26, 0x3fff};
+	uint32_t fixed_mcs[] = {26, 0x1fff};
+	bool mcs13_support = false;
+	uint16_t he_mcs_12_13_supp;
+	struct mac_context *mac_ctx;
+	QDF_STATUS status = QDF_STATUS_SUCCESS;
+
+	mac_ctx = sap_get_mac_context();
+	if (!mac_ctx) {
+		sap_err("Invalid MAC context");
+		return QDF_STATUS_E_INVAL;
+	}
+
+	he_mcs_12_13_supp = he_mcs_12_13_support();
+	mcs13_support = cfg_get(mac_ctx->psoc,
+				CFG_DISABLE_MCS13_SUPPORT);
+	sap_debug("session id %d, mcs13 support %d, he_mcs_12_13 %d, start %d, disabled_mcs13 %d, ch width %d",
+		  sap_ctx->sessionId, mcs13_support,
+		  he_mcs_12_13_supp,
+		  is_start, sap_ctx->disabled_mcs13,
+		  sap_ctx->ch_params.ch_width);
+
+	if (mcs13_support ||
+	    !he_mcs_12_13_supp)
+		return status;
+
+	if (!is_start && !sap_ctx->disabled_mcs13)
+		return status;
+
+	if (!is_mcs13_ch_width(sap_ctx->ch_params.ch_width))
+		return status;
+
+	if (is_start) {
+		status = sme_send_unit_test_cmd(sap_ctx->sessionId,
+						10, 2, fixed_mcs);
+		if (QDF_IS_STATUS_ERROR(status)) {
+			sap_err("Set fixed mcs rate failed, session %d",
+				sap_ctx->sessionId);
+		} else {
+			sap_ctx->disabled_mcs13 = true;
+		}
+	} else {
+		status = sme_send_unit_test_cmd(sap_ctx->sessionId,
+						10, 2, default_mcs);
+		if (QDF_IS_STATUS_ERROR(status)) {
+			sap_err("Set default mcs rate failed, session %d",
+				sap_ctx->sessionId);
+		} else {
+			sap_ctx->disabled_mcs13 = false;
+		}
+	}
+
+	return status;
+}
+
 /**
  * sap_goto_stopping() - Processing of SAP FSM stopping state
  * @sap_ctx: pointer to sap Context
@@ -1368,6 +1474,7 @@ static QDF_STATUS sap_goto_stopping(struct sap_context *sap_ctx)
 		return QDF_STATUS_E_FAULT;
 	}
 
+	sap_update_mcs_rate(sap_ctx, false);
 	sap_free_roam_profile(&sap_ctx->csr_roamProfile);
 	status = sme_roam_stop_bss(MAC_HANDLE(mac_ctx), sap_ctx->sessionId);
 	if (status != QDF_STATUS_SUCCESS) {
@@ -1946,9 +2053,11 @@ QDF_STATUS sap_signal_hdd_event(struct sap_context *sap_ctx,
 
 		bss_complete->operating_chan_freq = sap_ctx->chan_freq;
 		bss_complete->ch_width = sap_ctx->ch_params.ch_width;
-		if (QDF_IS_STATUS_SUCCESS(bss_complete->status))
+		if (QDF_IS_STATUS_SUCCESS(bss_complete->status)) {
 			sap_update_cac_history(mac_ctx, sap_ctx,
 					       sap_hddevent);
+			sap_update_mcs_rate(sap_ctx, true);
+		}
 		break;
 	case eSAP_DFS_CAC_START:
 	case eSAP_DFS_CAC_INTERRUPTED:

core/sap/src/sap_internal.h

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2021 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
@@ -231,6 +232,8 @@ struct sap_context {
 	uint8_t sap_sta_id;
 	bool dfs_cac_offload;
 	bool is_chan_change_inprogress;
+	/* Disabled mcs13 by sap or not */
+	bool disabled_mcs13;
 	qdf_list_t owe_pending_assoc_ind_list;
 	uint32_t freq_before_ch_switch;
 #ifdef WLAN_FEATURE_P2P_P2P_STA

core/sap/src/sap_module.c

@@ -753,6 +753,7 @@ QDF_STATUS wlansap_start_bss(struct sap_context *sap_ctx,
 	sap_ctx->dfs_cac_offload = config->dfs_cac_offload;
 	sap_ctx->isCacEndNotified = false;
 	sap_ctx->is_chan_change_inprogress = false;
+	sap_ctx->disabled_mcs13 = false;
 	sap_ctx->phyMode = config->SapHw_mode;
 	sap_ctx->csa_reason = CSA_REASON_UNKNOWN;