qcacld-3.0: Configure sar sleep index to FW

Currently there is no SAR index is configured to the FW
before device goes into suspend mode.
with the new requirement, configure the sleep mode index
as sar power limit to the FW before device goes into
suspend mode and configure safety mode index to the FW
on wakeup.

Change-Id: Icedbab047ec3bb252f0ed9c1b2baf04d2726a60e
CRs-Fixed: 2617102

core/hdd/src/wlan_hdd_power.c

@@ -81,6 +81,7 @@
 #include "wlan_p2p_ucfg_api.h"
 #include "wlan_mlme_ucfg_api.h"
 #include "wlan_osif_request_manager.h"
+#include <wlan_hdd_sar_limits.h>
 
 /* Preprocessor definitions and constants */
 #ifdef QCA_WIFI_NAPIER_EMULATION
@@ -1256,6 +1257,9 @@ hdd_suspend_wlan(void)
 		return -EAGAIN;
 
 	hdd_ctx->hdd_wlan_suspended = true;
+
+	hdd_configure_sar_sleep_index(hdd_ctx);
+
 	hdd_wlan_suspend_resume_event(HDD_WLAN_EARLY_SUSPEND);
 
 	return 0;
@@ -1314,6 +1318,8 @@ static int hdd_resume_wlan(void)
 	if (QDF_IS_STATUS_ERROR(status))
 		return qdf_status_to_os_return(status);
 
+	hdd_configure_sar_resume_index(hdd_ctx);
+
 	return 0;
 }
 

core/hdd/src/wlan_hdd_sar_limits.c

@@ -325,6 +325,63 @@ int wlan_hdd_cfg80211_get_sar_power_limits(struct wiphy *wiphy,
 }
 
 #ifdef SAR_SAFETY_FEATURE
+void hdd_disable_sar(struct hdd_context *hdd_ctx)
+{
+	struct sar_limit_cmd_params *sar_limit_cmd;
+	struct sar_limit_cmd_row *row;
+	QDF_STATUS status;
+
+	sar_limit_cmd = qdf_mem_malloc(sizeof(struct sar_limit_cmd_params));
+	if (!sar_limit_cmd)
+		return;
+
+	if (hdd_ctx->sar_version != SAR_VERSION_2) {
+		hdd_nofl_debug("FW SAR version: %d", hdd_ctx->sar_version);
+		return;
+	}
+
+	/*
+	 * Need two rows to hold the per-chain V2 power index
+	 */
+	row = qdf_mem_malloc(2 * sizeof(*row));
+	if (!row)
+		goto config_sar_failed;
+
+	sar_limit_cmd->sar_enable = WMI_SAR_FEATURE_OFF;
+	sar_limit_cmd->commit_limits = 1;
+	sar_limit_cmd->num_limit_rows = 2;
+	sar_limit_cmd->sar_limit_row_list = row;
+	row[0].limit_value = 0;
+	row[1].limit_value = 0;
+	row[0].chain_id = 0;
+	row[1].chain_id = 1;
+	row[0].validity_bitmap = WMI_SAR_CHAIN_ID_VALID_MASK;
+	row[1].validity_bitmap = WMI_SAR_CHAIN_ID_VALID_MASK;
+
+	hdd_nofl_debug("Disable the SAR limit index for both the chains");
+
+	status = sme_set_sar_power_limits(hdd_ctx->mac_handle, sar_limit_cmd);
+	if (QDF_IS_STATUS_ERROR(status)) {
+		hdd_nofl_err("Failed to set sar power limits");
+		goto config_sar_failed;
+	}
+
+	/* After SSR, the SAR configuration is lost. As SSR is hidden from
+	 * userland, this command will not come from userspace after a SSR. To
+	 * restore this configuration, save this in hdd context and restore
+	 * after re-init.
+	 */
+	hdd_store_sar_config(hdd_ctx, sar_limit_cmd);
+	return;
+
+config_sar_failed:
+
+	if (sar_limit_cmd) {
+		qdf_mem_free(sar_limit_cmd->sar_limit_row_list);
+		qdf_mem_free(sar_limit_cmd);
+	}
+}
+
 void hdd_configure_sar_index(struct hdd_context *hdd_ctx, uint32_t sar_index)
 {
 	struct sar_limit_cmd_params *sar_limit_cmd;
@@ -384,6 +441,31 @@ config_sar_failed:
 	}
 }
 
+void hdd_configure_sar_sleep_index(struct hdd_context *hdd_ctx)
+{
+	if (!hdd_ctx->config->enable_sar_safety)
+		return;
+
+	if (hdd_ctx->config->config_sar_safety_sleep_index) {
+		hdd_nofl_debug("Configure SAR sleep index %d",
+			       hdd_ctx->config->sar_safety_sleep_index);
+		hdd_configure_sar_index(
+				hdd_ctx,
+				hdd_ctx->config->sar_safety_sleep_index);
+	} else {
+		hdd_nofl_debug("Disable SAR");
+		hdd_disable_sar(hdd_ctx);
+	}
+}
+
+void hdd_configure_sar_resume_index(struct hdd_context *hdd_ctx)
+{
+	hdd_nofl_debug("Configure SAR safety index %d on wlan resume",
+		       hdd_ctx->config->sar_safety_index);
+	hdd_configure_sar_index(hdd_ctx,
+				hdd_ctx->config->sar_safety_index);
+}
+
 static void hdd_send_sar_unsolicited_event(struct hdd_context *hdd_ctx)
 {
 	struct sk_buff *vendor_event;

core/hdd/src/wlan_hdd_sar_limits.h

@@ -81,6 +81,36 @@ void wlan_hdd_sar_timers_deinit(struct hdd_context *hdd_ctx);
  */
 void hdd_configure_sar_index(struct hdd_context *hdd_ctx, uint32_t sar_index);
 
+/**
+ * hdd_disable_sar() - Disable SAR feature to FW
+ * @hdd_ctx: Pointer to HDD context
+ *
+ * This function Disables SAR power index on both the chains
+ *
+ * Return: None
+ */
+void hdd_disable_sar(struct hdd_context *hdd_ctx);
+
+/**
+ * hdd_configure_sar_sleep_index() - Configure SAR sleep index to FW
+ * @hdd_ctx: Pointer to HDD context
+ *
+ * This function configures SAR sleep index on both the chains
+ *
+ * Return: None
+ */
+void hdd_configure_sar_sleep_index(struct hdd_context *hdd_ctx);
+
+/**
+ * hdd_configure_sar_resume_index() - Configure SAR resume index to FW
+ * @hdd_ctx: Pointer to HDD context
+ *
+ * This function configures SAR resume index on both the chains
+ *
+ * Return: None
+ */
+void hdd_configure_sar_resume_index(struct hdd_context *hdd_ctx);
+
 #else
 static inline void wlan_hdd_sar_unsolicited_timer_start(
 						struct hdd_context *hdd_ctx)
@@ -103,6 +133,19 @@ static inline void hdd_configure_sar_index(struct hdd_context *hdd_ctx,
 					   uint32_t sar_index)
 {
 }
+
+static inline void hdd_disable_sar(struct hdd_context *hdd_ctx)
+{
+}
+
+static inline void hdd_configure_sar_sleep_index(struct hdd_context *hdd_ctx)
+{
+}
+
+static inline void hdd_configure_sar_resume_index(struct hdd_context *hdd_ctx)
+{
+}
+
 #endif
 
 /**