qcacld-3.0: Fine tune PM QOS vote for allowing/preventing RTPM

For CPU, the enter & exit latency of the deepest LPM mode(CXPC) is
about ~10ms. So long as required QoS latency is longer than 10ms,
CPU can enter CXPC mode. Add 10 ms threshold for allowing and
preventing dynamic RTPM from PM QOS callback.

Change-Id: I8e3026e0e1bab548ab727a52569de9cb17fb5918
CRs-Fixed: 3032657

core/hdd/inc/wlan_hdd_power.h

@@ -452,13 +452,16 @@ int wlan_hdd_pm_qos_notify(struct notifier_block *nb, unsigned long curr_val,
  *
  * This function check for PM QoS global vote.
  *
+ * @hdd_ctx: hdd_context pointer
+ *
  * Return: true if there is PM QoS global vote,
  *	   or an false otherwise
  */
 #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)
-bool wlan_hdd_is_cpu_pm_qos_in_progress(void);
+bool wlan_hdd_is_cpu_pm_qos_in_progress(struct hdd_context *hdd_ctx);
 #else
-static inline bool wlan_hdd_is_cpu_pm_qos_in_progress(void)
+static inline bool
+wlan_hdd_is_cpu_pm_qos_in_progress(struct hdd_context *hdd_ctx)
 {
 	return false;
 }

core/hdd/src/wlan_hdd_cm_disconnect.c

@@ -434,14 +434,58 @@ hdd_cm_disconnect_complete_post_user_update(struct wlan_objmgr_vdev *vdev,
 	return QDF_STATUS_SUCCESS;
 }
 
+#ifdef FEATURE_RUNTIME_PM
+static void
+wlan_hdd_runtime_pm_wow_disconnect_handler(struct hdd_context *hdd_ctx)
+{
+	struct hif_opaque_softc *hif_ctx;
+
+	if (!hdd_ctx) {
+		hdd_err("hdd_ctx is NULL");
+		return;
+	}
+
+	hif_ctx = cds_get_context(QDF_MODULE_ID_HIF);
+	if (!hif_ctx) {
+		hdd_err("hif_ctx is NULL");
+		return;
+	}
+
+	if (hdd_is_any_sta_connected(hdd_ctx)) {
+		hdd_debug("active connections: runtime pm prevented: %d",
+			  hdd_ctx->runtime_pm_prevented);
+		return;
+	}
+
+	hdd_debug("Runtime allowed : %d", hdd_ctx->runtime_pm_prevented);
+	qdf_spin_lock_irqsave(&hdd_ctx->pm_qos_lock);
+	if (hdd_ctx->runtime_pm_prevented) {
+		hif_pm_runtime_put(hif_ctx, RTPM_ID_QOS_NOTIFY);
+		hdd_ctx->runtime_pm_prevented = false;
+	}
+	qdf_spin_unlock_irqrestore(&hdd_ctx->pm_qos_lock);
+}
+#else
+static void
+wlan_hdd_runtime_pm_wow_disconnect_handler(struct hdd_context *hdd_ctx)
+{
+}
+#endif
+
 QDF_STATUS hdd_cm_disconnect_complete(struct wlan_objmgr_vdev *vdev,
 				      struct wlan_cm_discon_rsp *rsp,
 				      enum osif_cb_type type)
 {
+	struct hdd_context *hdd_ctx = cds_get_context(QDF_MODULE_ID_HDD);
+
 	switch (type) {
 	case OSIF_PRE_USERSPACE_UPDATE:
 		return hdd_cm_disconnect_complete_pre_user_update(vdev, rsp);
 	case OSIF_POST_USERSPACE_UPDATE:
+		hdd_debug("Wifi disconnected: vdev id %d",
+			  vdev->vdev_objmgr.vdev_id);
+		wlan_hdd_runtime_pm_wow_disconnect_handler(hdd_ctx);
+
 		return hdd_cm_disconnect_complete_post_user_update(vdev, rsp);
 	default:
 		hdd_cm_disconnect_complete_pre_user_update(vdev, rsp);

core/hdd/src/wlan_hdd_driver_ops.c

@@ -1622,7 +1622,7 @@ static int wlan_hdd_runtime_suspend(struct device *dev)
 		return -EBUSY;
 	}
 
-	if (wlan_hdd_is_cpu_pm_qos_in_progress()) {
+	if (wlan_hdd_is_cpu_pm_qos_in_progress(hdd_ctx)) {
 		hdd_debug("PM QoS Latency constraint, ignore runtime suspend");
 		return -EBUSY;
 	}

core/hdd/src/wlan_hdd_power.c

@@ -1169,6 +1169,20 @@ int wlan_hdd_ipv4_changed(struct notifier_block *nb,
 }
 
 #ifdef FEATURE_RUNTIME_PM
+/* For CPU, the enter & exit latency of the deepest LPM mode(CXPC)
+ * is about ~10ms. so long as required QoS latency is longer than 10ms,
+ * CPU can enter CXPC mode.
+ * The vote value is in microseconds.
+ */
+#define HDD_CPU_CXPC_THRESHOLD (10000)
+static bool wlan_hdd_is_cpu_cxpc_allowed(unsigned long vote)
+{
+	if (vote >= HDD_CPU_CXPC_THRESHOLD)
+		return true;
+	else
+		return false;
+}
+
 int wlan_hdd_pm_qos_notify(struct notifier_block *nb, unsigned long curr_val,
 			   void *context)
 {
@@ -1195,11 +1209,11 @@ int wlan_hdd_pm_qos_notify(struct notifier_block *nb, unsigned long curr_val,
 
 	if (!hdd_ctx->runtime_pm_prevented &&
 	    is_any_sta_connected &&
-	    curr_val != wlan_hdd_get_pm_qos_cpu_latency()) {
+	    !wlan_hdd_is_cpu_cxpc_allowed(curr_val)) {
 		hif_pm_runtime_get_noresume(hif_ctx, RTPM_ID_QOS_NOTIFY);
 		hdd_ctx->runtime_pm_prevented = true;
 	} else if (hdd_ctx->runtime_pm_prevented &&
-		   curr_val == wlan_hdd_get_pm_qos_cpu_latency()) {
+		   wlan_hdd_is_cpu_cxpc_allowed(curr_val)) {
 		hif_pm_runtime_put(hif_ctx, RTPM_ID_QOS_NOTIFY);
 		hdd_ctx->runtime_pm_prevented = false;
 	}
@@ -1210,24 +1224,29 @@ int wlan_hdd_pm_qos_notify(struct notifier_block *nb, unsigned long curr_val,
 }
 
 #if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)
-bool wlan_hdd_is_cpu_pm_qos_in_progress(void)
+bool wlan_hdd_is_cpu_pm_qos_in_progress(struct hdd_context *hdd_ctx)
 {
-	unsigned long pm_qos_cpu_latency;
-	long long curr_val;
+	long long curr_val_ns;
+	long long curr_val_us;
 	int max_cpu_num;
 
+	if (!hdd_is_any_sta_connected(hdd_ctx)) {
+		hdd_debug("No active wifi connections. Ignore PM QOS vote");
+		return false;
+	}
+
 	max_cpu_num  = nr_cpu_ids - 1;
-	pm_qos_cpu_latency = wlan_hdd_get_pm_qos_cpu_latency() * NSEC_PER_USEC;
 
 	/* Get PM QoS vote from last cpu, as no device votes on that cpu
 	 * so by default we get global PM QoS vote from last cpu.
 	 */
-	curr_val = cpuidle_governor_latency_req(max_cpu_num);
-	if (curr_val != pm_qos_cpu_latency) {
-		hdd_debug("PM QoS current value: %lld", curr_val);
+	curr_val_ns = cpuidle_governor_latency_req(max_cpu_num);
+	curr_val_us = curr_val_ns / NSEC_PER_USEC;
+	hdd_debug("PM QoS current value: %lld", curr_val_us);
+	if (!wlan_hdd_is_cpu_cxpc_allowed(curr_val_us))
 		return true;
-	}
-	return false;
+	else
+		return false;
 }
 #endif
 #endif