msm: ipa: fix to tx stop channel

When opt dpath is enabled, make changes to stop and start the
channel only when it is required.

Change-Id: I849ccbe969a6c965b18022f3c23e545902d551e2
Signed-off-by: Chaitanya Pratapa <[email protected]>

drivers/platform/msm/gsi/gsi.c

@@ -3415,6 +3415,11 @@ int gsi_start_channel(unsigned long chan_hdl)
 
 	ctx = &gsi_ctx->chan[chan_hdl];
 
+	if (ctx->state == GSI_CHAN_STATE_STARTED) {
+		GSIDBG("chan_hdl=%lu already in started state\n", chan_hdl);
+		return GSI_STATUS_SUCCESS;
+	}
+
 	if (ctx->state != GSI_CHAN_STATE_ALLOCATED &&
 		ctx->state != GSI_CHAN_STATE_STOP_IN_PROC &&
 		ctx->state != GSI_CHAN_STATE_STOPPED) {

drivers/platform/msm/ipa/ipa_clients/ipa_wdi3.c

@@ -1179,7 +1179,7 @@ int ipa_wdi_opt_dpath_rsrv_filter_req(
 		ipa_wdi_ctx_list[0]->opt_dpath_info.q6_rtng_table_index =
 			req->q6_rtng_table_index;
 
-		ipa3_enable_wdi3_opt_dpath(ipa_ep_idx_rx,
+		ipa3_enable_wdi3_opt_dpath(ipa_ep_idx_rx, ipa_ep_idx_tx,
 			ipa_wdi_ctx_list[0]->opt_dpath_info.q6_rtng_table_index);
 	}
 
@@ -1351,7 +1351,7 @@ int ipa_wdi_opt_dpath_remove_all_filter_req(
 			struct ipa_wlan_opt_dp_remove_all_filter_resp_msg_v01 *resp)
 {
 	int ret = 0;
-	int ipa_ep_idx_rx;
+	int ipa_ep_idx_rx, ipa_ep_idx_tx;
 
 	memset(resp, 0, sizeof(struct ipa_wlan_opt_dp_remove_all_filter_resp_msg_v01));
 
@@ -1382,19 +1382,22 @@ int ipa_wdi_opt_dpath_remove_all_filter_req(
 	if (ipa_wdi_ctx_list[0]->wdi_version >= IPA_WDI_3) {
 		if (IPA_CLIENT_IS_WLAN0_INSTANCE(ipa_wdi_ctx_list[0]->inst_id)) {
 			ipa_ep_idx_rx = ipa_get_ep_mapping(IPA_CLIENT_WLAN2_PROD);
+			ipa_ep_idx_tx = ipa_get_ep_mapping(IPA_CLIENT_WLAN2_CONS);
 		} else {
 			ipa_ep_idx_rx = ipa_get_ep_mapping(IPA_CLIENT_WLAN3_PROD);
+			ipa_ep_idx_tx = ipa_get_ep_mapping(IPA_CLIENT_WLAN4_CONS);
 		}
 	} else {
 		ipa_ep_idx_rx = ipa_get_ep_mapping(IPA_CLIENT_WLAN1_PROD);
+		ipa_ep_idx_tx = ipa_get_ep_mapping(IPA_CLIENT_WLAN1_CONS);
 	}
 
-	if (ipa_ep_idx_rx <= 0) {
-		IPA_WDI_ERR("Either RX ep is not configured. \n");
+	if (ipa_ep_idx_rx <= 0 || ipa_ep_idx_tx <= 0) {
+		IPA_WDI_ERR("Either RX ep or TX ep is not configured. \n");
 		return 0;
 	}
 
-	ipa3_disable_wdi3_opt_dpath(ipa_ep_idx_rx);
+	ipa3_disable_wdi3_opt_dpath(ipa_ep_idx_rx, ipa_ep_idx_tx);
 
 	resp->resp.result = ret;
 	resp->resp.error = IPA_QMI_ERR_NONE_V01;

drivers/platform/msm/ipa/ipa_common_i.h

@@ -630,9 +630,9 @@ int ipa3_enable_wdi3_pipes(int ipa_ep_idx_tx, int ipa_ep_idx_rx,
 int ipa3_disable_wdi3_pipes(int ipa_ep_idx_tx, int ipa_ep_idx_rx,
 	int ipa_ep_idx_tx1);
 
-int ipa3_enable_wdi3_opt_dpath(int ipa_ep_idx_rx, u32 rt_tbl_idx);
-
-int ipa3_disable_wdi3_opt_dpath(int ipa_ep_idx_rx);
+int ipa3_enable_wdi3_opt_dpath(int ipa_ep_idx_rx, int ipa_ep_idx_tx,
+	u32 rt_tbl_idx);
+int ipa3_disable_wdi3_opt_dpath(int ipa_ep_idx_rx, int ipa_ep_idx_tx);
 
 const char *ipa_get_version_string(enum ipa_hw_type ver);
 int ipa3_start_gsi_channel(u32 clnt_hdl);

drivers/platform/msm/ipa/ipa_v3/ipa_wdi3_i.c

@@ -1034,7 +1034,7 @@ int ipa3_disconn_wdi3_pipes(int ipa_ep_idx_tx, int ipa_ep_idx_rx,
 		ipa3_uc_debug_stats_dealloc(IPA_HW_PROTOCOL_WDI3);
 
 	if (ipa3_ctx->ipa_wdi_opt_dpath)
-		ipa3_disable_wdi3_opt_dpath(ipa_ep_idx_rx);
+		ipa3_disable_wdi3_opt_dpath(ipa_ep_idx_rx, ipa_ep_idx_tx);
 
 	ipa3_delete_dflt_flt_rules(ipa_ep_idx_rx);
 	memset(ep_rx, 0, sizeof(struct ipa3_ep_context));
@@ -1404,43 +1404,81 @@ int ipa3_get_wdi3_gsi_stats(struct ipa_uc_dbg_ring_stats *stats)
 	return 0;
 }
 
-int ipa3_enable_wdi3_opt_dpath(int ipa_ep_idx_rx, u32 rt_tbl_idx)
+int ipa3_enable_wdi3_opt_dpath(int ipa_ep_idx_rx, int ipa_ep_idx_tx,
+	u32 rt_tbl_idx)
 {
 	int result = 0;
+	struct ipa3_ep_context *ep_tx = NULL;
 
 	/* wdi3 only support over gsi */
 	if (ipa_get_wdi_version() < IPA_WDI_3) {
-		IPAERR("wdi3 over uc offload not supported");
-		WARN_ON(1);
+		IPADBG("wdi3 over uc offload not supported");
 		return -EFAULT;
 	}
 
-	IPADBG("ep_rx = %d\n", ipa_ep_idx_rx);
+	IPADBG("ep_rx = %d, ep_tx = %d\n", ipa_ep_idx_rx, ipa_ep_idx_tx);
 	IPADBG("rt_tbl_idx = %d\n", rt_tbl_idx);
 
+	IPA_ACTIVE_CLIENTS_INC_SIMPLE();
+
 	/* Install default filter rules.*/
 	ipa3_install_dl_opt_wdi_dpath_flt_rules(ipa_ep_idx_rx, rt_tbl_idx);
 
+	result = ipa3_enable_data_path(ipa_ep_idx_tx);
+	if (result) {
+		IPADBG("enable data path failed res=%d clnt=%d\n", result,
+			ipa_ep_idx_tx);
+	}
+
+	ep_tx = &ipa3_ctx->ep[ipa_ep_idx_tx];
+	/* start gsi tx channel */
+	result = gsi_start_channel(ep_tx->gsi_chan_hdl);
+	if (result) {
+		IPADBG("failed to start gsi tx channel\n");
+	}
+
+	IPA_ACTIVE_CLIENTS_DEC_SIMPLE();
+
 	return result;
 }
 EXPORT_SYMBOL(ipa3_enable_wdi3_opt_dpath);
 
-int ipa3_disable_wdi3_opt_dpath(int ipa_ep_idx_rx)
+int ipa3_disable_wdi3_opt_dpath(int ipa_ep_idx_rx, int ipa_ep_idx_tx)
 {
 	int result = 0;
 
 	/* wdi3 only support over gsi */
 	if (ipa_get_wdi_version() < IPA_WDI_3) {
-		IPAERR("wdi3 over uc offload not supported");
-		WARN_ON(1);
+		IPADBG("wdi3 over uc offload not supported");
 		return -EFAULT;
 	}
 
-	IPADBG("ep_rx = %d\n", ipa_ep_idx_rx);
+	IPA_ACTIVE_CLIENTS_INC_SIMPLE();
+
+	IPADBG("ep_rx = %d, ep_tx = %d\n", ipa_ep_idx_rx, ipa_ep_idx_tx);
 
 	/* Install default filter rules.*/
 	ipa3_delete_dl_opt_wdi_dpath_flt_rules(ipa_ep_idx_rx);
 
+	/* disable tx data path */
+	result = ipa3_disable_data_path(ipa_ep_idx_tx);
+	if (result) {
+		IPADBG("disable data path failed res=%d clnt=%d.\n", result,
+			ipa_ep_idx_tx);
+		result = -EFAULT;
+		goto fail;
+	}
+
+	/* stop gsi tx channel */
+	result = ipa_stop_gsi_channel(ipa_ep_idx_tx);
+	if (result) {
+		IPADBG("failed to stop gsi tx channel\n");
+		result = -EFAULT;
+		goto fail;
+	}
+
+fail:
+	IPA_ACTIVE_CLIENTS_DEC_SIMPLE();
 	return result;
 }
 EXPORT_SYMBOL(ipa3_disable_wdi3_opt_dpath);