xref: /openbmc/linux/drivers/dma/ti/k3-udma-glue.c (revision aa8a4c4edad0bed7aaf3a7cfcae9fa555d847955)
1d7024191SGrygorii Strashko // SPDX-License-Identifier: GPL-2.0
2d7024191SGrygorii Strashko /*
3d7024191SGrygorii Strashko  * K3 NAVSS DMA glue interface
4d7024191SGrygorii Strashko  *
5d7024191SGrygorii Strashko  * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com
6d7024191SGrygorii Strashko  *
7d7024191SGrygorii Strashko  */
8d7024191SGrygorii Strashko 
9d7024191SGrygorii Strashko #include <linux/atomic.h>
10d7024191SGrygorii Strashko #include <linux/delay.h>
11d7024191SGrygorii Strashko #include <linux/dma-mapping.h>
12d7024191SGrygorii Strashko #include <linux/io.h>
13d7024191SGrygorii Strashko #include <linux/init.h>
14d7024191SGrygorii Strashko #include <linux/of.h>
15d7024191SGrygorii Strashko #include <linux/platform_device.h>
16d7024191SGrygorii Strashko #include <linux/soc/ti/k3-ringacc.h>
17d7024191SGrygorii Strashko #include <linux/dma/ti-cppi5.h>
18d7024191SGrygorii Strashko #include <linux/dma/k3-udma-glue.h>
19d7024191SGrygorii Strashko 
20d7024191SGrygorii Strashko #include "k3-udma.h"
21d7024191SGrygorii Strashko #include "k3-psil-priv.h"
22d7024191SGrygorii Strashko 
23d7024191SGrygorii Strashko struct k3_udma_glue_common {
24d7024191SGrygorii Strashko 	struct device *dev;
25d7024191SGrygorii Strashko 	struct udma_dev *udmax;
26d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm;
27d7024191SGrygorii Strashko 	struct k3_ringacc *ringacc;
28d7024191SGrygorii Strashko 	u32 src_thread;
29d7024191SGrygorii Strashko 	u32 dst_thread;
30d7024191SGrygorii Strashko 
31d7024191SGrygorii Strashko 	u32  hdesc_size;
32d7024191SGrygorii Strashko 	bool epib;
33d7024191SGrygorii Strashko 	u32  psdata_size;
34d7024191SGrygorii Strashko 	u32  swdata_size;
350ebcf1a2SPeter Ujfalusi 	u32  atype;
36d7024191SGrygorii Strashko };
37d7024191SGrygorii Strashko 
38d7024191SGrygorii Strashko struct k3_udma_glue_tx_channel {
39d7024191SGrygorii Strashko 	struct k3_udma_glue_common common;
40d7024191SGrygorii Strashko 
41d7024191SGrygorii Strashko 	struct udma_tchan *udma_tchanx;
42d7024191SGrygorii Strashko 	int udma_tchan_id;
43d7024191SGrygorii Strashko 
44d7024191SGrygorii Strashko 	struct k3_ring *ringtx;
45d7024191SGrygorii Strashko 	struct k3_ring *ringtxcq;
46d7024191SGrygorii Strashko 
47d7024191SGrygorii Strashko 	bool psil_paired;
48d7024191SGrygorii Strashko 
49d7024191SGrygorii Strashko 	int virq;
50d7024191SGrygorii Strashko 
51d7024191SGrygorii Strashko 	atomic_t free_pkts;
52d7024191SGrygorii Strashko 	bool tx_pause_on_err;
53d7024191SGrygorii Strashko 	bool tx_filt_einfo;
54d7024191SGrygorii Strashko 	bool tx_filt_pswords;
55d7024191SGrygorii Strashko 	bool tx_supr_tdpkt;
56d7024191SGrygorii Strashko };
57d7024191SGrygorii Strashko 
58d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow {
59d7024191SGrygorii Strashko 	struct udma_rflow *udma_rflow;
60d7024191SGrygorii Strashko 	int udma_rflow_id;
61d7024191SGrygorii Strashko 	struct k3_ring *ringrx;
62d7024191SGrygorii Strashko 	struct k3_ring *ringrxfdq;
63d7024191SGrygorii Strashko 
64d7024191SGrygorii Strashko 	int virq;
65d7024191SGrygorii Strashko };
66d7024191SGrygorii Strashko 
67d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel {
68d7024191SGrygorii Strashko 	struct k3_udma_glue_common common;
69d7024191SGrygorii Strashko 
70d7024191SGrygorii Strashko 	struct udma_rchan *udma_rchanx;
71d7024191SGrygorii Strashko 	int udma_rchan_id;
72d7024191SGrygorii Strashko 	bool remote;
73d7024191SGrygorii Strashko 
74d7024191SGrygorii Strashko 	bool psil_paired;
75d7024191SGrygorii Strashko 
76d7024191SGrygorii Strashko 	u32  swdata_size;
77d7024191SGrygorii Strashko 	int  flow_id_base;
78d7024191SGrygorii Strashko 
79d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flows;
80d7024191SGrygorii Strashko 	u32 flow_num;
81d7024191SGrygorii Strashko 	u32 flows_ready;
82d7024191SGrygorii Strashko };
83d7024191SGrygorii Strashko 
84d7024191SGrygorii Strashko #define K3_UDMAX_TDOWN_TIMEOUT_US 1000
85d7024191SGrygorii Strashko 
86d7024191SGrygorii Strashko static int of_k3_udma_glue_parse(struct device_node *udmax_np,
87d7024191SGrygorii Strashko 				 struct k3_udma_glue_common *common)
88d7024191SGrygorii Strashko {
89d7024191SGrygorii Strashko 	common->udmax = of_xudma_dev_get(udmax_np, NULL);
90d7024191SGrygorii Strashko 	if (IS_ERR(common->udmax))
91d7024191SGrygorii Strashko 		return PTR_ERR(common->udmax);
92d7024191SGrygorii Strashko 
93*aa8a4c4eSPeter Ujfalusi 	common->ringacc = xudma_get_ringacc(common->udmax);
94d7024191SGrygorii Strashko 	common->tisci_rm = xudma_dev_get_tisci_rm(common->udmax);
95d7024191SGrygorii Strashko 
96d7024191SGrygorii Strashko 	return 0;
97d7024191SGrygorii Strashko }
98d7024191SGrygorii Strashko 
99d7024191SGrygorii Strashko static int of_k3_udma_glue_parse_chn(struct device_node *chn_np,
100d7024191SGrygorii Strashko 		const char *name, struct k3_udma_glue_common *common,
101d7024191SGrygorii Strashko 		bool tx_chn)
102d7024191SGrygorii Strashko {
103d7024191SGrygorii Strashko 	struct psil_endpoint_config *ep_config;
104d7024191SGrygorii Strashko 	struct of_phandle_args dma_spec;
105d7024191SGrygorii Strashko 	u32 thread_id;
106d7024191SGrygorii Strashko 	int ret = 0;
107d7024191SGrygorii Strashko 	int index;
108d7024191SGrygorii Strashko 
109d7024191SGrygorii Strashko 	if (unlikely(!name))
110d7024191SGrygorii Strashko 		return -EINVAL;
111d7024191SGrygorii Strashko 
112d7024191SGrygorii Strashko 	index = of_property_match_string(chn_np, "dma-names", name);
113d7024191SGrygorii Strashko 	if (index < 0)
114d7024191SGrygorii Strashko 		return index;
115d7024191SGrygorii Strashko 
116d7024191SGrygorii Strashko 	if (of_parse_phandle_with_args(chn_np, "dmas", "#dma-cells", index,
117d7024191SGrygorii Strashko 				       &dma_spec))
118d7024191SGrygorii Strashko 		return -ENOENT;
119d7024191SGrygorii Strashko 
120d7024191SGrygorii Strashko 	thread_id = dma_spec.args[0];
1210ebcf1a2SPeter Ujfalusi 	if (dma_spec.args_count == 2) {
1220ebcf1a2SPeter Ujfalusi 		if (dma_spec.args[1] > 2) {
1230ebcf1a2SPeter Ujfalusi 			dev_err(common->dev, "Invalid channel atype: %u\n",
1240ebcf1a2SPeter Ujfalusi 				dma_spec.args[1]);
1250ebcf1a2SPeter Ujfalusi 			ret = -EINVAL;
1260ebcf1a2SPeter Ujfalusi 			goto out_put_spec;
1270ebcf1a2SPeter Ujfalusi 		}
1280ebcf1a2SPeter Ujfalusi 		common->atype = dma_spec.args[1];
1290ebcf1a2SPeter Ujfalusi 	}
130d7024191SGrygorii Strashko 
131d7024191SGrygorii Strashko 	if (tx_chn && !(thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) {
132d7024191SGrygorii Strashko 		ret = -EINVAL;
133d7024191SGrygorii Strashko 		goto out_put_spec;
134d7024191SGrygorii Strashko 	}
135d7024191SGrygorii Strashko 
136d7024191SGrygorii Strashko 	if (!tx_chn && (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) {
137d7024191SGrygorii Strashko 		ret = -EINVAL;
138d7024191SGrygorii Strashko 		goto out_put_spec;
139d7024191SGrygorii Strashko 	}
140d7024191SGrygorii Strashko 
141d7024191SGrygorii Strashko 	/* get psil endpoint config */
142d7024191SGrygorii Strashko 	ep_config = psil_get_ep_config(thread_id);
143d7024191SGrygorii Strashko 	if (IS_ERR(ep_config)) {
144d7024191SGrygorii Strashko 		dev_err(common->dev,
145d7024191SGrygorii Strashko 			"No configuration for psi-l thread 0x%04x\n",
146d7024191SGrygorii Strashko 			thread_id);
147d7024191SGrygorii Strashko 		ret = PTR_ERR(ep_config);
148d7024191SGrygorii Strashko 		goto out_put_spec;
149d7024191SGrygorii Strashko 	}
150d7024191SGrygorii Strashko 
151d7024191SGrygorii Strashko 	common->epib = ep_config->needs_epib;
152d7024191SGrygorii Strashko 	common->psdata_size = ep_config->psd_size;
153d7024191SGrygorii Strashko 
154d7024191SGrygorii Strashko 	if (tx_chn)
155d7024191SGrygorii Strashko 		common->dst_thread = thread_id;
156d7024191SGrygorii Strashko 	else
157d7024191SGrygorii Strashko 		common->src_thread = thread_id;
158d7024191SGrygorii Strashko 
159d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse(dma_spec.np, common);
160d7024191SGrygorii Strashko 
161d7024191SGrygorii Strashko out_put_spec:
162d7024191SGrygorii Strashko 	of_node_put(dma_spec.np);
163d7024191SGrygorii Strashko 	return ret;
164d7024191SGrygorii Strashko };
165d7024191SGrygorii Strashko 
166d7024191SGrygorii Strashko static void k3_udma_glue_dump_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
167d7024191SGrygorii Strashko {
168d7024191SGrygorii Strashko 	struct device *dev = tx_chn->common.dev;
169d7024191SGrygorii Strashko 
170d7024191SGrygorii Strashko 	dev_dbg(dev, "dump_tx_chn:\n"
171d7024191SGrygorii Strashko 		"udma_tchan_id: %d\n"
172d7024191SGrygorii Strashko 		"src_thread: %08x\n"
173d7024191SGrygorii Strashko 		"dst_thread: %08x\n",
174d7024191SGrygorii Strashko 		tx_chn->udma_tchan_id,
175d7024191SGrygorii Strashko 		tx_chn->common.src_thread,
176d7024191SGrygorii Strashko 		tx_chn->common.dst_thread);
177d7024191SGrygorii Strashko }
178d7024191SGrygorii Strashko 
179d7024191SGrygorii Strashko static void k3_udma_glue_dump_tx_rt_chn(struct k3_udma_glue_tx_channel *chn,
180d7024191SGrygorii Strashko 					char *mark)
181d7024191SGrygorii Strashko {
182d7024191SGrygorii Strashko 	struct device *dev = chn->common.dev;
183d7024191SGrygorii Strashko 
184d7024191SGrygorii Strashko 	dev_dbg(dev, "=== dump ===> %s\n", mark);
185bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG,
186bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG));
187bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG,
188d7024191SGrygorii Strashko 		xudma_tchanrt_read(chn->udma_tchanx,
189bc7e5523SPeter Ujfalusi 				   UDMA_CHAN_RT_PEER_RT_EN_REG));
190bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG,
191bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_PCNT_REG));
192bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG,
193bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_BCNT_REG));
194bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG,
195bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_SBCNT_REG));
196d7024191SGrygorii Strashko }
197d7024191SGrygorii Strashko 
198d7024191SGrygorii Strashko static int k3_udma_glue_cfg_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
199d7024191SGrygorii Strashko {
200d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = tx_chn->common.tisci_rm;
201d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_tx_ch_cfg req;
202d7024191SGrygorii Strashko 
203d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
204d7024191SGrygorii Strashko 
205d7024191SGrygorii Strashko 	req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_PAUSE_ON_ERR_VALID |
206d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_EINFO_VALID |
207d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_PSWORDS_VALID |
208d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID |
209d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_SUPR_TDPKT_VALID |
210d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID |
2110ebcf1a2SPeter Ujfalusi 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID |
2120ebcf1a2SPeter Ujfalusi 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID;
213d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
214d7024191SGrygorii Strashko 	req.index = tx_chn->udma_tchan_id;
215d7024191SGrygorii Strashko 	if (tx_chn->tx_pause_on_err)
216d7024191SGrygorii Strashko 		req.tx_pause_on_err = 1;
217d7024191SGrygorii Strashko 	if (tx_chn->tx_filt_einfo)
218d7024191SGrygorii Strashko 		req.tx_filt_einfo = 1;
219d7024191SGrygorii Strashko 	if (tx_chn->tx_filt_pswords)
220d7024191SGrygorii Strashko 		req.tx_filt_pswords = 1;
221d7024191SGrygorii Strashko 	req.tx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR;
222d7024191SGrygorii Strashko 	if (tx_chn->tx_supr_tdpkt)
223d7024191SGrygorii Strashko 		req.tx_supr_tdpkt = 1;
224d7024191SGrygorii Strashko 	req.tx_fetch_size = tx_chn->common.hdesc_size >> 2;
225d7024191SGrygorii Strashko 	req.txcq_qnum = k3_ringacc_get_ring_id(tx_chn->ringtxcq);
2260ebcf1a2SPeter Ujfalusi 	req.tx_atype = tx_chn->common.atype;
227d7024191SGrygorii Strashko 
228d7024191SGrygorii Strashko 	return tisci_rm->tisci_udmap_ops->tx_ch_cfg(tisci_rm->tisci, &req);
229d7024191SGrygorii Strashko }
230d7024191SGrygorii Strashko 
231d7024191SGrygorii Strashko struct k3_udma_glue_tx_channel *k3_udma_glue_request_tx_chn(struct device *dev,
232d7024191SGrygorii Strashko 		const char *name, struct k3_udma_glue_tx_channel_cfg *cfg)
233d7024191SGrygorii Strashko {
234d7024191SGrygorii Strashko 	struct k3_udma_glue_tx_channel *tx_chn;
235d7024191SGrygorii Strashko 	int ret;
236d7024191SGrygorii Strashko 
237d7024191SGrygorii Strashko 	tx_chn = devm_kzalloc(dev, sizeof(*tx_chn), GFP_KERNEL);
238d7024191SGrygorii Strashko 	if (!tx_chn)
239d7024191SGrygorii Strashko 		return ERR_PTR(-ENOMEM);
240d7024191SGrygorii Strashko 
241d7024191SGrygorii Strashko 	tx_chn->common.dev = dev;
242d7024191SGrygorii Strashko 	tx_chn->common.swdata_size = cfg->swdata_size;
243d7024191SGrygorii Strashko 	tx_chn->tx_pause_on_err = cfg->tx_pause_on_err;
244d7024191SGrygorii Strashko 	tx_chn->tx_filt_einfo = cfg->tx_filt_einfo;
245d7024191SGrygorii Strashko 	tx_chn->tx_filt_pswords = cfg->tx_filt_pswords;
246d7024191SGrygorii Strashko 	tx_chn->tx_supr_tdpkt = cfg->tx_supr_tdpkt;
247d7024191SGrygorii Strashko 
248d7024191SGrygorii Strashko 	/* parse of udmap channel */
249d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse_chn(dev->of_node, name,
250d7024191SGrygorii Strashko 					&tx_chn->common, true);
251d7024191SGrygorii Strashko 	if (ret)
252d7024191SGrygorii Strashko 		goto err;
253d7024191SGrygorii Strashko 
254d7024191SGrygorii Strashko 	tx_chn->common.hdesc_size = cppi5_hdesc_calc_size(tx_chn->common.epib,
255d7024191SGrygorii Strashko 						tx_chn->common.psdata_size,
256d7024191SGrygorii Strashko 						tx_chn->common.swdata_size);
257d7024191SGrygorii Strashko 
258d7024191SGrygorii Strashko 	/* request and cfg UDMAP TX channel */
259d7024191SGrygorii Strashko 	tx_chn->udma_tchanx = xudma_tchan_get(tx_chn->common.udmax, -1);
260d7024191SGrygorii Strashko 	if (IS_ERR(tx_chn->udma_tchanx)) {
261d7024191SGrygorii Strashko 		ret = PTR_ERR(tx_chn->udma_tchanx);
262d7024191SGrygorii Strashko 		dev_err(dev, "UDMAX tchanx get err %d\n", ret);
263d7024191SGrygorii Strashko 		goto err;
264d7024191SGrygorii Strashko 	}
265d7024191SGrygorii Strashko 	tx_chn->udma_tchan_id = xudma_tchan_get_id(tx_chn->udma_tchanx);
266d7024191SGrygorii Strashko 
267d7024191SGrygorii Strashko 	atomic_set(&tx_chn->free_pkts, cfg->txcq_cfg.size);
268d7024191SGrygorii Strashko 
269d7024191SGrygorii Strashko 	/* request and cfg rings */
2704927b1abSPeter Ujfalusi 	ret =  k3_ringacc_request_rings_pair(tx_chn->common.ringacc,
2714927b1abSPeter Ujfalusi 					     tx_chn->udma_tchan_id, -1,
2724927b1abSPeter Ujfalusi 					     &tx_chn->ringtx,
2734927b1abSPeter Ujfalusi 					     &tx_chn->ringtxcq);
2744927b1abSPeter Ujfalusi 	if (ret) {
2754927b1abSPeter Ujfalusi 		dev_err(dev, "Failed to get TX/TXCQ rings %d\n", ret);
276d7024191SGrygorii Strashko 		goto err;
277d7024191SGrygorii Strashko 	}
278d7024191SGrygorii Strashko 
279d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(tx_chn->ringtx, &cfg->tx_cfg);
280d7024191SGrygorii Strashko 	if (ret) {
281d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringtx %d\n", ret);
282d7024191SGrygorii Strashko 		goto err;
283d7024191SGrygorii Strashko 	}
284d7024191SGrygorii Strashko 
285d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(tx_chn->ringtxcq, &cfg->txcq_cfg);
286d7024191SGrygorii Strashko 	if (ret) {
287d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringtx %d\n", ret);
288d7024191SGrygorii Strashko 		goto err;
289d7024191SGrygorii Strashko 	}
290d7024191SGrygorii Strashko 
291d7024191SGrygorii Strashko 	/* request and cfg psi-l */
292d7024191SGrygorii Strashko 	tx_chn->common.src_thread =
293d7024191SGrygorii Strashko 			xudma_dev_get_psil_base(tx_chn->common.udmax) +
294d7024191SGrygorii Strashko 			tx_chn->udma_tchan_id;
295d7024191SGrygorii Strashko 
296d7024191SGrygorii Strashko 	ret = k3_udma_glue_cfg_tx_chn(tx_chn);
297d7024191SGrygorii Strashko 	if (ret) {
298d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg tchan %d\n", ret);
299d7024191SGrygorii Strashko 		goto err;
300d7024191SGrygorii Strashko 	}
301d7024191SGrygorii Strashko 
302d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_chn(tx_chn);
303d7024191SGrygorii Strashko 
304d7024191SGrygorii Strashko 	return tx_chn;
305d7024191SGrygorii Strashko 
306d7024191SGrygorii Strashko err:
307d7024191SGrygorii Strashko 	k3_udma_glue_release_tx_chn(tx_chn);
308d7024191SGrygorii Strashko 	return ERR_PTR(ret);
309d7024191SGrygorii Strashko }
310d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_request_tx_chn);
311d7024191SGrygorii Strashko 
312d7024191SGrygorii Strashko void k3_udma_glue_release_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
313d7024191SGrygorii Strashko {
314d7024191SGrygorii Strashko 	if (tx_chn->psil_paired) {
315d7024191SGrygorii Strashko 		xudma_navss_psil_unpair(tx_chn->common.udmax,
316d7024191SGrygorii Strashko 					tx_chn->common.src_thread,
317d7024191SGrygorii Strashko 					tx_chn->common.dst_thread);
318d7024191SGrygorii Strashko 		tx_chn->psil_paired = false;
319d7024191SGrygorii Strashko 	}
320d7024191SGrygorii Strashko 
321d7024191SGrygorii Strashko 	if (!IS_ERR_OR_NULL(tx_chn->udma_tchanx))
322d7024191SGrygorii Strashko 		xudma_tchan_put(tx_chn->common.udmax,
323d7024191SGrygorii Strashko 				tx_chn->udma_tchanx);
324d7024191SGrygorii Strashko 
325d7024191SGrygorii Strashko 	if (tx_chn->ringtxcq)
326d7024191SGrygorii Strashko 		k3_ringacc_ring_free(tx_chn->ringtxcq);
327d7024191SGrygorii Strashko 
328d7024191SGrygorii Strashko 	if (tx_chn->ringtx)
329d7024191SGrygorii Strashko 		k3_ringacc_ring_free(tx_chn->ringtx);
330d7024191SGrygorii Strashko }
331d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_release_tx_chn);
332d7024191SGrygorii Strashko 
333d7024191SGrygorii Strashko int k3_udma_glue_push_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
334d7024191SGrygorii Strashko 			     struct cppi5_host_desc_t *desc_tx,
335d7024191SGrygorii Strashko 			     dma_addr_t desc_dma)
336d7024191SGrygorii Strashko {
337d7024191SGrygorii Strashko 	u32 ringtxcq_id;
338d7024191SGrygorii Strashko 
339d7024191SGrygorii Strashko 	if (!atomic_add_unless(&tx_chn->free_pkts, -1, 0))
340d7024191SGrygorii Strashko 		return -ENOMEM;
341d7024191SGrygorii Strashko 
342d7024191SGrygorii Strashko 	ringtxcq_id = k3_ringacc_get_ring_id(tx_chn->ringtxcq);
343d7024191SGrygorii Strashko 	cppi5_desc_set_retpolicy(&desc_tx->hdr, 0, ringtxcq_id);
344d7024191SGrygorii Strashko 
345d7024191SGrygorii Strashko 	return k3_ringacc_ring_push(tx_chn->ringtx, &desc_dma);
346d7024191SGrygorii Strashko }
347d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_push_tx_chn);
348d7024191SGrygorii Strashko 
349d7024191SGrygorii Strashko int k3_udma_glue_pop_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
350d7024191SGrygorii Strashko 			    dma_addr_t *desc_dma)
351d7024191SGrygorii Strashko {
352d7024191SGrygorii Strashko 	int ret;
353d7024191SGrygorii Strashko 
354d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_pop(tx_chn->ringtxcq, desc_dma);
355d7024191SGrygorii Strashko 	if (!ret)
356d7024191SGrygorii Strashko 		atomic_inc(&tx_chn->free_pkts);
357d7024191SGrygorii Strashko 
358d7024191SGrygorii Strashko 	return ret;
359d7024191SGrygorii Strashko }
360d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_pop_tx_chn);
361d7024191SGrygorii Strashko 
362d7024191SGrygorii Strashko int k3_udma_glue_enable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
363d7024191SGrygorii Strashko {
36469973b48SGrygorii Strashko 	int ret;
36569973b48SGrygorii Strashko 
36669973b48SGrygorii Strashko 	ret = xudma_navss_psil_pair(tx_chn->common.udmax,
36769973b48SGrygorii Strashko 				    tx_chn->common.src_thread,
36869973b48SGrygorii Strashko 				    tx_chn->common.dst_thread);
36969973b48SGrygorii Strashko 	if (ret) {
37069973b48SGrygorii Strashko 		dev_err(tx_chn->common.dev, "PSI-L request err %d\n", ret);
37169973b48SGrygorii Strashko 		return ret;
37269973b48SGrygorii Strashko 	}
37369973b48SGrygorii Strashko 
37469973b48SGrygorii Strashko 	tx_chn->psil_paired = true;
37569973b48SGrygorii Strashko 
376bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_PEER_RT_EN_REG,
37752c74d3dSGrygorii Strashko 			    UDMA_PEER_RT_EN_ENABLE);
378d7024191SGrygorii Strashko 
379bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG,
38052c74d3dSGrygorii Strashko 			    UDMA_CHAN_RT_CTL_EN);
381d7024191SGrygorii Strashko 
382d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn en");
383d7024191SGrygorii Strashko 	return 0;
384d7024191SGrygorii Strashko }
385d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_enable_tx_chn);
386d7024191SGrygorii Strashko 
387d7024191SGrygorii Strashko void k3_udma_glue_disable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
388d7024191SGrygorii Strashko {
389d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis1");
390d7024191SGrygorii Strashko 
391bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 0);
392d7024191SGrygorii Strashko 
393d7024191SGrygorii Strashko 	xudma_tchanrt_write(tx_chn->udma_tchanx,
394bc7e5523SPeter Ujfalusi 			    UDMA_CHAN_RT_PEER_RT_EN_REG, 0);
395d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis2");
39669973b48SGrygorii Strashko 
39769973b48SGrygorii Strashko 	if (tx_chn->psil_paired) {
39869973b48SGrygorii Strashko 		xudma_navss_psil_unpair(tx_chn->common.udmax,
39969973b48SGrygorii Strashko 					tx_chn->common.src_thread,
40069973b48SGrygorii Strashko 					tx_chn->common.dst_thread);
40169973b48SGrygorii Strashko 		tx_chn->psil_paired = false;
40269973b48SGrygorii Strashko 	}
403d7024191SGrygorii Strashko }
404d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_disable_tx_chn);
405d7024191SGrygorii Strashko 
406d7024191SGrygorii Strashko void k3_udma_glue_tdown_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
407d7024191SGrygorii Strashko 			       bool sync)
408d7024191SGrygorii Strashko {
409d7024191SGrygorii Strashko 	int i = 0;
410d7024191SGrygorii Strashko 	u32 val;
411d7024191SGrygorii Strashko 
412d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown1");
413d7024191SGrygorii Strashko 
414bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG,
415d7024191SGrygorii Strashko 			    UDMA_CHAN_RT_CTL_EN | UDMA_CHAN_RT_CTL_TDOWN);
416d7024191SGrygorii Strashko 
417bc7e5523SPeter Ujfalusi 	val = xudma_tchanrt_read(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG);
418d7024191SGrygorii Strashko 
419d7024191SGrygorii Strashko 	while (sync && (val & UDMA_CHAN_RT_CTL_EN)) {
420d7024191SGrygorii Strashko 		val = xudma_tchanrt_read(tx_chn->udma_tchanx,
421bc7e5523SPeter Ujfalusi 					 UDMA_CHAN_RT_CTL_REG);
422d7024191SGrygorii Strashko 		udelay(1);
423d7024191SGrygorii Strashko 		if (i > K3_UDMAX_TDOWN_TIMEOUT_US) {
424d7024191SGrygorii Strashko 			dev_err(tx_chn->common.dev, "TX tdown timeout\n");
425d7024191SGrygorii Strashko 			break;
426d7024191SGrygorii Strashko 		}
427d7024191SGrygorii Strashko 		i++;
428d7024191SGrygorii Strashko 	}
429d7024191SGrygorii Strashko 
430d7024191SGrygorii Strashko 	val = xudma_tchanrt_read(tx_chn->udma_tchanx,
431bc7e5523SPeter Ujfalusi 				 UDMA_CHAN_RT_PEER_RT_EN_REG);
432d7024191SGrygorii Strashko 	if (sync && (val & UDMA_PEER_RT_EN_ENABLE))
433d7024191SGrygorii Strashko 		dev_err(tx_chn->common.dev, "TX tdown peer not stopped\n");
434d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown2");
435d7024191SGrygorii Strashko }
436d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tdown_tx_chn);
437d7024191SGrygorii Strashko 
438d7024191SGrygorii Strashko void k3_udma_glue_reset_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
439d7024191SGrygorii Strashko 			       void *data,
440d7024191SGrygorii Strashko 			       void (*cleanup)(void *data, dma_addr_t desc_dma))
441d7024191SGrygorii Strashko {
442d7024191SGrygorii Strashko 	dma_addr_t desc_dma;
443d7024191SGrygorii Strashko 	int occ_tx, i, ret;
444d7024191SGrygorii Strashko 
445d7024191SGrygorii Strashko 	/* reset TXCQ as it is not input for udma - expected to be empty */
446d7024191SGrygorii Strashko 	if (tx_chn->ringtxcq)
447d7024191SGrygorii Strashko 		k3_ringacc_ring_reset(tx_chn->ringtxcq);
448d7024191SGrygorii Strashko 
449d7024191SGrygorii Strashko 	/*
450d7024191SGrygorii Strashko 	 * TXQ reset need to be special way as it is input for udma and its
451d7024191SGrygorii Strashko 	 * state cached by udma, so:
452d7024191SGrygorii Strashko 	 * 1) save TXQ occ
453d7024191SGrygorii Strashko 	 * 2) clean up TXQ and call callback .cleanup() for each desc
454d7024191SGrygorii Strashko 	 * 3) reset TXQ in a special way
455d7024191SGrygorii Strashko 	 */
456d7024191SGrygorii Strashko 	occ_tx = k3_ringacc_ring_get_occ(tx_chn->ringtx);
457d7024191SGrygorii Strashko 	dev_dbg(tx_chn->common.dev, "TX reset occ_tx %u\n", occ_tx);
458d7024191SGrygorii Strashko 
459d7024191SGrygorii Strashko 	for (i = 0; i < occ_tx; i++) {
460d7024191SGrygorii Strashko 		ret = k3_ringacc_ring_pop(tx_chn->ringtx, &desc_dma);
461d7024191SGrygorii Strashko 		if (ret) {
462d7024191SGrygorii Strashko 			dev_err(tx_chn->common.dev, "TX reset pop %d\n", ret);
463d7024191SGrygorii Strashko 			break;
464d7024191SGrygorii Strashko 		}
465d7024191SGrygorii Strashko 		cleanup(data, desc_dma);
466d7024191SGrygorii Strashko 	}
467d7024191SGrygorii Strashko 
468d7024191SGrygorii Strashko 	k3_ringacc_ring_reset_dma(tx_chn->ringtx, occ_tx);
469d7024191SGrygorii Strashko }
470d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_reset_tx_chn);
471d7024191SGrygorii Strashko 
472d7024191SGrygorii Strashko u32 k3_udma_glue_tx_get_hdesc_size(struct k3_udma_glue_tx_channel *tx_chn)
473d7024191SGrygorii Strashko {
474d7024191SGrygorii Strashko 	return tx_chn->common.hdesc_size;
475d7024191SGrygorii Strashko }
476d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_hdesc_size);
477d7024191SGrygorii Strashko 
478d7024191SGrygorii Strashko u32 k3_udma_glue_tx_get_txcq_id(struct k3_udma_glue_tx_channel *tx_chn)
479d7024191SGrygorii Strashko {
480d7024191SGrygorii Strashko 	return k3_ringacc_get_ring_id(tx_chn->ringtxcq);
481d7024191SGrygorii Strashko }
482d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_txcq_id);
483d7024191SGrygorii Strashko 
484d7024191SGrygorii Strashko int k3_udma_glue_tx_get_irq(struct k3_udma_glue_tx_channel *tx_chn)
485d7024191SGrygorii Strashko {
486d7024191SGrygorii Strashko 	tx_chn->virq = k3_ringacc_get_ring_irq_num(tx_chn->ringtxcq);
487d7024191SGrygorii Strashko 
488d7024191SGrygorii Strashko 	return tx_chn->virq;
489d7024191SGrygorii Strashko }
490d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_irq);
491d7024191SGrygorii Strashko 
492426506a7SPeter Ujfalusi struct device *
493426506a7SPeter Ujfalusi 	k3_udma_glue_tx_get_dma_device(struct k3_udma_glue_tx_channel *tx_chn)
494426506a7SPeter Ujfalusi {
495426506a7SPeter Ujfalusi 	return xudma_get_device(tx_chn->common.udmax);
496426506a7SPeter Ujfalusi }
497426506a7SPeter Ujfalusi EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_dma_device);
498426506a7SPeter Ujfalusi 
499d7024191SGrygorii Strashko static int k3_udma_glue_cfg_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
500d7024191SGrygorii Strashko {
501d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
502d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_rx_ch_cfg req;
503d7024191SGrygorii Strashko 	int ret;
504d7024191SGrygorii Strashko 
505d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
506d7024191SGrygorii Strashko 
507d7024191SGrygorii Strashko 	req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID |
508d7024191SGrygorii Strashko 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID |
509d7024191SGrygorii Strashko 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID |
510d7024191SGrygorii Strashko 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_START_VALID |
5110ebcf1a2SPeter Ujfalusi 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_CNT_VALID |
5120ebcf1a2SPeter Ujfalusi 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID;
513d7024191SGrygorii Strashko 
514d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
515d7024191SGrygorii Strashko 	req.index = rx_chn->udma_rchan_id;
516d7024191SGrygorii Strashko 	req.rx_fetch_size = rx_chn->common.hdesc_size >> 2;
517d7024191SGrygorii Strashko 	/*
518d7024191SGrygorii Strashko 	 * TODO: we can't support rxcq_qnum/RCHAN[a]_RCQ cfg with current sysfw
519d7024191SGrygorii Strashko 	 * and udmax impl, so just configure it to invalid value.
520d7024191SGrygorii Strashko 	 * req.rxcq_qnum = k3_ringacc_get_ring_id(rx_chn->flows[0].ringrx);
521d7024191SGrygorii Strashko 	 */
522d7024191SGrygorii Strashko 	req.rxcq_qnum = 0xFFFF;
523d7024191SGrygorii Strashko 	if (rx_chn->flow_num && rx_chn->flow_id_base != rx_chn->udma_rchan_id) {
524d7024191SGrygorii Strashko 		/* Default flow + extra ones */
525d7024191SGrygorii Strashko 		req.flowid_start = rx_chn->flow_id_base;
526d7024191SGrygorii Strashko 		req.flowid_cnt = rx_chn->flow_num;
527d7024191SGrygorii Strashko 	}
528d7024191SGrygorii Strashko 	req.rx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR;
5290ebcf1a2SPeter Ujfalusi 	req.rx_atype = rx_chn->common.atype;
530d7024191SGrygorii Strashko 
531d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_ch_cfg(tisci_rm->tisci, &req);
532d7024191SGrygorii Strashko 	if (ret)
533d7024191SGrygorii Strashko 		dev_err(rx_chn->common.dev, "rchan%d cfg failed %d\n",
534d7024191SGrygorii Strashko 			rx_chn->udma_rchan_id, ret);
535d7024191SGrygorii Strashko 
536d7024191SGrygorii Strashko 	return ret;
537d7024191SGrygorii Strashko }
538d7024191SGrygorii Strashko 
539d7024191SGrygorii Strashko static void k3_udma_glue_release_rx_flow(struct k3_udma_glue_rx_channel *rx_chn,
540d7024191SGrygorii Strashko 					 u32 flow_num)
541d7024191SGrygorii Strashko {
542d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
543d7024191SGrygorii Strashko 
544d7024191SGrygorii Strashko 	if (IS_ERR_OR_NULL(flow->udma_rflow))
545d7024191SGrygorii Strashko 		return;
546d7024191SGrygorii Strashko 
547d7024191SGrygorii Strashko 	if (flow->ringrxfdq)
548d7024191SGrygorii Strashko 		k3_ringacc_ring_free(flow->ringrxfdq);
549d7024191SGrygorii Strashko 
550d7024191SGrygorii Strashko 	if (flow->ringrx)
551d7024191SGrygorii Strashko 		k3_ringacc_ring_free(flow->ringrx);
552d7024191SGrygorii Strashko 
553d7024191SGrygorii Strashko 	xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow);
554d7024191SGrygorii Strashko 	flow->udma_rflow = NULL;
555d7024191SGrygorii Strashko 	rx_chn->flows_ready--;
556d7024191SGrygorii Strashko }
557d7024191SGrygorii Strashko 
558d7024191SGrygorii Strashko static int k3_udma_glue_cfg_rx_flow(struct k3_udma_glue_rx_channel *rx_chn,
559d7024191SGrygorii Strashko 				    u32 flow_idx,
560d7024191SGrygorii Strashko 				    struct k3_udma_glue_rx_flow_cfg *flow_cfg)
561d7024191SGrygorii Strashko {
562d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx];
563d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
564d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
565d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_flow_cfg req;
566d7024191SGrygorii Strashko 	int rx_ring_id;
567d7024191SGrygorii Strashko 	int rx_ringfdq_id;
568d7024191SGrygorii Strashko 	int ret = 0;
569d7024191SGrygorii Strashko 
570d7024191SGrygorii Strashko 	flow->udma_rflow = xudma_rflow_get(rx_chn->common.udmax,
571d7024191SGrygorii Strashko 					   flow->udma_rflow_id);
572d7024191SGrygorii Strashko 	if (IS_ERR(flow->udma_rflow)) {
573d7024191SGrygorii Strashko 		ret = PTR_ERR(flow->udma_rflow);
574d7024191SGrygorii Strashko 		dev_err(dev, "UDMAX rflow get err %d\n", ret);
575018af9beSChristophe JAILLET 		return ret;
576d7024191SGrygorii Strashko 	}
577d7024191SGrygorii Strashko 
578d7024191SGrygorii Strashko 	if (flow->udma_rflow_id != xudma_rflow_get_id(flow->udma_rflow)) {
579018af9beSChristophe JAILLET 		ret = -ENODEV;
580018af9beSChristophe JAILLET 		goto err_rflow_put;
581d7024191SGrygorii Strashko 	}
582d7024191SGrygorii Strashko 
583d7024191SGrygorii Strashko 	/* request and cfg rings */
5844927b1abSPeter Ujfalusi 	ret =  k3_ringacc_request_rings_pair(rx_chn->common.ringacc,
5854927b1abSPeter Ujfalusi 					     flow_cfg->ring_rxfdq0_id,
5866259c844SPeter Ujfalusi 					     flow_cfg->ring_rxq_id,
5874927b1abSPeter Ujfalusi 					     &flow->ringrxfdq,
5884927b1abSPeter Ujfalusi 					     &flow->ringrx);
5894927b1abSPeter Ujfalusi 	if (ret) {
5904927b1abSPeter Ujfalusi 		dev_err(dev, "Failed to get RX/RXFDQ rings %d\n", ret);
591018af9beSChristophe JAILLET 		goto err_rflow_put;
592d7024191SGrygorii Strashko 	}
593d7024191SGrygorii Strashko 
594d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(flow->ringrx, &flow_cfg->rx_cfg);
595d7024191SGrygorii Strashko 	if (ret) {
596d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringrx %d\n", ret);
597018af9beSChristophe JAILLET 		goto err_ringrxfdq_free;
598d7024191SGrygorii Strashko 	}
599d7024191SGrygorii Strashko 
600d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(flow->ringrxfdq, &flow_cfg->rxfdq_cfg);
601d7024191SGrygorii Strashko 	if (ret) {
602d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringrxfdq %d\n", ret);
603018af9beSChristophe JAILLET 		goto err_ringrxfdq_free;
604d7024191SGrygorii Strashko 	}
605d7024191SGrygorii Strashko 
606d7024191SGrygorii Strashko 	if (rx_chn->remote) {
607d7024191SGrygorii Strashko 		rx_ring_id = TI_SCI_RESOURCE_NULL;
608d7024191SGrygorii Strashko 		rx_ringfdq_id = TI_SCI_RESOURCE_NULL;
609d7024191SGrygorii Strashko 	} else {
610d7024191SGrygorii Strashko 		rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx);
611d7024191SGrygorii Strashko 		rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq);
612d7024191SGrygorii Strashko 	}
613d7024191SGrygorii Strashko 
614d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
615d7024191SGrygorii Strashko 
616d7024191SGrygorii Strashko 	req.valid_params =
617d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_EINFO_PRESENT_VALID |
618d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_PSINFO_PRESENT_VALID |
619d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_ERROR_HANDLING_VALID |
620d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DESC_TYPE_VALID |
621d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID |
622d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_HI_SEL_VALID |
623d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_LO_SEL_VALID |
624d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_HI_SEL_VALID |
625d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_LO_SEL_VALID |
626d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID |
627d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID |
628d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID |
629d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID;
630d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
631d7024191SGrygorii Strashko 	req.flow_index = flow->udma_rflow_id;
632d7024191SGrygorii Strashko 	if (rx_chn->common.epib)
633d7024191SGrygorii Strashko 		req.rx_einfo_present = 1;
634d7024191SGrygorii Strashko 	if (rx_chn->common.psdata_size)
635d7024191SGrygorii Strashko 		req.rx_psinfo_present = 1;
636d7024191SGrygorii Strashko 	if (flow_cfg->rx_error_handling)
637d7024191SGrygorii Strashko 		req.rx_error_handling = 1;
638d7024191SGrygorii Strashko 	req.rx_desc_type = 0;
639d7024191SGrygorii Strashko 	req.rx_dest_qnum = rx_ring_id;
640d7024191SGrygorii Strashko 	req.rx_src_tag_hi_sel = 0;
641d7024191SGrygorii Strashko 	req.rx_src_tag_lo_sel = flow_cfg->src_tag_lo_sel;
642d7024191SGrygorii Strashko 	req.rx_dest_tag_hi_sel = 0;
643d7024191SGrygorii Strashko 	req.rx_dest_tag_lo_sel = 0;
644d7024191SGrygorii Strashko 	req.rx_fdq0_sz0_qnum = rx_ringfdq_id;
645d7024191SGrygorii Strashko 	req.rx_fdq1_qnum = rx_ringfdq_id;
646d7024191SGrygorii Strashko 	req.rx_fdq2_qnum = rx_ringfdq_id;
647d7024191SGrygorii Strashko 	req.rx_fdq3_qnum = rx_ringfdq_id;
648d7024191SGrygorii Strashko 
649d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req);
650d7024191SGrygorii Strashko 	if (ret) {
651d7024191SGrygorii Strashko 		dev_err(dev, "flow%d config failed: %d\n", flow->udma_rflow_id,
652d7024191SGrygorii Strashko 			ret);
653018af9beSChristophe JAILLET 		goto err_ringrxfdq_free;
654d7024191SGrygorii Strashko 	}
655d7024191SGrygorii Strashko 
656d7024191SGrygorii Strashko 	rx_chn->flows_ready++;
657d7024191SGrygorii Strashko 	dev_dbg(dev, "flow%d config done. ready:%d\n",
658d7024191SGrygorii Strashko 		flow->udma_rflow_id, rx_chn->flows_ready);
659d7024191SGrygorii Strashko 
660d7024191SGrygorii Strashko 	return 0;
661018af9beSChristophe JAILLET 
662018af9beSChristophe JAILLET err_ringrxfdq_free:
663018af9beSChristophe JAILLET 	k3_ringacc_ring_free(flow->ringrxfdq);
664018af9beSChristophe JAILLET 	k3_ringacc_ring_free(flow->ringrx);
665018af9beSChristophe JAILLET 
666018af9beSChristophe JAILLET err_rflow_put:
667018af9beSChristophe JAILLET 	xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow);
668018af9beSChristophe JAILLET 	flow->udma_rflow = NULL;
669018af9beSChristophe JAILLET 
670d7024191SGrygorii Strashko 	return ret;
671d7024191SGrygorii Strashko }
672d7024191SGrygorii Strashko 
673d7024191SGrygorii Strashko static void k3_udma_glue_dump_rx_chn(struct k3_udma_glue_rx_channel *chn)
674d7024191SGrygorii Strashko {
675d7024191SGrygorii Strashko 	struct device *dev = chn->common.dev;
676d7024191SGrygorii Strashko 
677d7024191SGrygorii Strashko 	dev_dbg(dev, "dump_rx_chn:\n"
678d7024191SGrygorii Strashko 		"udma_rchan_id: %d\n"
679d7024191SGrygorii Strashko 		"src_thread: %08x\n"
680d7024191SGrygorii Strashko 		"dst_thread: %08x\n"
681d7024191SGrygorii Strashko 		"epib: %d\n"
682d7024191SGrygorii Strashko 		"hdesc_size: %u\n"
683d7024191SGrygorii Strashko 		"psdata_size: %u\n"
684d7024191SGrygorii Strashko 		"swdata_size: %u\n"
685d7024191SGrygorii Strashko 		"flow_id_base: %d\n"
686d7024191SGrygorii Strashko 		"flow_num: %d\n",
687d7024191SGrygorii Strashko 		chn->udma_rchan_id,
688d7024191SGrygorii Strashko 		chn->common.src_thread,
689d7024191SGrygorii Strashko 		chn->common.dst_thread,
690d7024191SGrygorii Strashko 		chn->common.epib,
691d7024191SGrygorii Strashko 		chn->common.hdesc_size,
692d7024191SGrygorii Strashko 		chn->common.psdata_size,
693d7024191SGrygorii Strashko 		chn->common.swdata_size,
694d7024191SGrygorii Strashko 		chn->flow_id_base,
695d7024191SGrygorii Strashko 		chn->flow_num);
696d7024191SGrygorii Strashko }
697d7024191SGrygorii Strashko 
698d7024191SGrygorii Strashko static void k3_udma_glue_dump_rx_rt_chn(struct k3_udma_glue_rx_channel *chn,
699d7024191SGrygorii Strashko 					char *mark)
700d7024191SGrygorii Strashko {
701d7024191SGrygorii Strashko 	struct device *dev = chn->common.dev;
702d7024191SGrygorii Strashko 
703d7024191SGrygorii Strashko 	dev_dbg(dev, "=== dump ===> %s\n", mark);
704d7024191SGrygorii Strashko 
705bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG,
706bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG));
707bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG,
708d7024191SGrygorii Strashko 		xudma_rchanrt_read(chn->udma_rchanx,
709bc7e5523SPeter Ujfalusi 				   UDMA_CHAN_RT_PEER_RT_EN_REG));
710bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG,
711bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_PCNT_REG));
712bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG,
713bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_BCNT_REG));
714bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG,
715bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_SBCNT_REG));
716d7024191SGrygorii Strashko }
717d7024191SGrygorii Strashko 
718d7024191SGrygorii Strashko static int
719d7024191SGrygorii Strashko k3_udma_glue_allocate_rx_flows(struct k3_udma_glue_rx_channel *rx_chn,
720d7024191SGrygorii Strashko 			       struct k3_udma_glue_rx_channel_cfg *cfg)
721d7024191SGrygorii Strashko {
722d7024191SGrygorii Strashko 	int ret;
723d7024191SGrygorii Strashko 
724d7024191SGrygorii Strashko 	/* default rflow */
725d7024191SGrygorii Strashko 	if (cfg->flow_id_use_rxchan_id)
726d7024191SGrygorii Strashko 		return 0;
727d7024191SGrygorii Strashko 
728d7024191SGrygorii Strashko 	/* not a GP rflows */
729d7024191SGrygorii Strashko 	if (rx_chn->flow_id_base != -1 &&
730d7024191SGrygorii Strashko 	    !xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base))
731d7024191SGrygorii Strashko 		return 0;
732d7024191SGrygorii Strashko 
733d7024191SGrygorii Strashko 	/* Allocate range of GP rflows */
734d7024191SGrygorii Strashko 	ret = xudma_alloc_gp_rflow_range(rx_chn->common.udmax,
735d7024191SGrygorii Strashko 					 rx_chn->flow_id_base,
736d7024191SGrygorii Strashko 					 rx_chn->flow_num);
737d7024191SGrygorii Strashko 	if (ret < 0) {
738d7024191SGrygorii Strashko 		dev_err(rx_chn->common.dev, "UDMAX reserve_rflow %d cnt:%d err: %d\n",
739d7024191SGrygorii Strashko 			rx_chn->flow_id_base, rx_chn->flow_num, ret);
740d7024191SGrygorii Strashko 		return ret;
741d7024191SGrygorii Strashko 	}
742d7024191SGrygorii Strashko 	rx_chn->flow_id_base = ret;
743d7024191SGrygorii Strashko 
744d7024191SGrygorii Strashko 	return 0;
745d7024191SGrygorii Strashko }
746d7024191SGrygorii Strashko 
747d7024191SGrygorii Strashko static struct k3_udma_glue_rx_channel *
748d7024191SGrygorii Strashko k3_udma_glue_request_rx_chn_priv(struct device *dev, const char *name,
749d7024191SGrygorii Strashko 				 struct k3_udma_glue_rx_channel_cfg *cfg)
750d7024191SGrygorii Strashko {
751d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_channel *rx_chn;
752d7024191SGrygorii Strashko 	int ret, i;
753d7024191SGrygorii Strashko 
754d7024191SGrygorii Strashko 	if (cfg->flow_id_num <= 0)
755d7024191SGrygorii Strashko 		return ERR_PTR(-EINVAL);
756d7024191SGrygorii Strashko 
757d7024191SGrygorii Strashko 	if (cfg->flow_id_num != 1 &&
758d7024191SGrygorii Strashko 	    (cfg->def_flow_cfg || cfg->flow_id_use_rxchan_id))
759d7024191SGrygorii Strashko 		return ERR_PTR(-EINVAL);
760d7024191SGrygorii Strashko 
761d7024191SGrygorii Strashko 	rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL);
762d7024191SGrygorii Strashko 	if (!rx_chn)
763d7024191SGrygorii Strashko 		return ERR_PTR(-ENOMEM);
764d7024191SGrygorii Strashko 
765d7024191SGrygorii Strashko 	rx_chn->common.dev = dev;
766d7024191SGrygorii Strashko 	rx_chn->common.swdata_size = cfg->swdata_size;
767d7024191SGrygorii Strashko 	rx_chn->remote = false;
768d7024191SGrygorii Strashko 
769d7024191SGrygorii Strashko 	/* parse of udmap channel */
770d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse_chn(dev->of_node, name,
771d7024191SGrygorii Strashko 					&rx_chn->common, false);
772d7024191SGrygorii Strashko 	if (ret)
773d7024191SGrygorii Strashko 		goto err;
774d7024191SGrygorii Strashko 
775d7024191SGrygorii Strashko 	rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib,
776d7024191SGrygorii Strashko 						rx_chn->common.psdata_size,
777d7024191SGrygorii Strashko 						rx_chn->common.swdata_size);
778d7024191SGrygorii Strashko 
779d7024191SGrygorii Strashko 	/* request and cfg UDMAP RX channel */
780d7024191SGrygorii Strashko 	rx_chn->udma_rchanx = xudma_rchan_get(rx_chn->common.udmax, -1);
781d7024191SGrygorii Strashko 	if (IS_ERR(rx_chn->udma_rchanx)) {
782d7024191SGrygorii Strashko 		ret = PTR_ERR(rx_chn->udma_rchanx);
783d7024191SGrygorii Strashko 		dev_err(dev, "UDMAX rchanx get err %d\n", ret);
784d7024191SGrygorii Strashko 		goto err;
785d7024191SGrygorii Strashko 	}
786d7024191SGrygorii Strashko 	rx_chn->udma_rchan_id = xudma_rchan_get_id(rx_chn->udma_rchanx);
787d7024191SGrygorii Strashko 
788d7024191SGrygorii Strashko 	rx_chn->flow_num = cfg->flow_id_num;
789d7024191SGrygorii Strashko 	rx_chn->flow_id_base = cfg->flow_id_base;
790d7024191SGrygorii Strashko 
791d7024191SGrygorii Strashko 	/* Use RX channel id as flow id: target dev can't generate flow_id */
792d7024191SGrygorii Strashko 	if (cfg->flow_id_use_rxchan_id)
793d7024191SGrygorii Strashko 		rx_chn->flow_id_base = rx_chn->udma_rchan_id;
794d7024191SGrygorii Strashko 
795d7024191SGrygorii Strashko 	rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num,
796d7024191SGrygorii Strashko 				     sizeof(*rx_chn->flows), GFP_KERNEL);
797d7024191SGrygorii Strashko 	if (!rx_chn->flows) {
798d7024191SGrygorii Strashko 		ret = -ENOMEM;
799d7024191SGrygorii Strashko 		goto err;
800d7024191SGrygorii Strashko 	}
801d7024191SGrygorii Strashko 
802d7024191SGrygorii Strashko 	ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg);
803d7024191SGrygorii Strashko 	if (ret)
804d7024191SGrygorii Strashko 		goto err;
805d7024191SGrygorii Strashko 
806d7024191SGrygorii Strashko 	for (i = 0; i < rx_chn->flow_num; i++)
807d7024191SGrygorii Strashko 		rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i;
808d7024191SGrygorii Strashko 
809d7024191SGrygorii Strashko 	/* request and cfg psi-l */
810d7024191SGrygorii Strashko 	rx_chn->common.dst_thread =
811d7024191SGrygorii Strashko 			xudma_dev_get_psil_base(rx_chn->common.udmax) +
812d7024191SGrygorii Strashko 			rx_chn->udma_rchan_id;
813d7024191SGrygorii Strashko 
814d7024191SGrygorii Strashko 	ret = k3_udma_glue_cfg_rx_chn(rx_chn);
815d7024191SGrygorii Strashko 	if (ret) {
816d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg rchan %d\n", ret);
817d7024191SGrygorii Strashko 		goto err;
818d7024191SGrygorii Strashko 	}
819d7024191SGrygorii Strashko 
820d7024191SGrygorii Strashko 	/* init default RX flow only if flow_num = 1 */
821d7024191SGrygorii Strashko 	if (cfg->def_flow_cfg) {
822d7024191SGrygorii Strashko 		ret = k3_udma_glue_cfg_rx_flow(rx_chn, 0, cfg->def_flow_cfg);
823d7024191SGrygorii Strashko 		if (ret)
824d7024191SGrygorii Strashko 			goto err;
825d7024191SGrygorii Strashko 	}
826d7024191SGrygorii Strashko 
827d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_chn(rx_chn);
828d7024191SGrygorii Strashko 
829d7024191SGrygorii Strashko 	return rx_chn;
830d7024191SGrygorii Strashko 
831d7024191SGrygorii Strashko err:
832d7024191SGrygorii Strashko 	k3_udma_glue_release_rx_chn(rx_chn);
833d7024191SGrygorii Strashko 	return ERR_PTR(ret);
834d7024191SGrygorii Strashko }
835d7024191SGrygorii Strashko 
836d7024191SGrygorii Strashko static struct k3_udma_glue_rx_channel *
837d7024191SGrygorii Strashko k3_udma_glue_request_remote_rx_chn(struct device *dev, const char *name,
838d7024191SGrygorii Strashko 				   struct k3_udma_glue_rx_channel_cfg *cfg)
839d7024191SGrygorii Strashko {
840d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_channel *rx_chn;
841d7024191SGrygorii Strashko 	int ret, i;
842d7024191SGrygorii Strashko 
843d7024191SGrygorii Strashko 	if (cfg->flow_id_num <= 0 ||
844d7024191SGrygorii Strashko 	    cfg->flow_id_use_rxchan_id ||
845d7024191SGrygorii Strashko 	    cfg->def_flow_cfg ||
846d7024191SGrygorii Strashko 	    cfg->flow_id_base < 0)
847d7024191SGrygorii Strashko 		return ERR_PTR(-EINVAL);
848d7024191SGrygorii Strashko 
849d7024191SGrygorii Strashko 	/*
850d7024191SGrygorii Strashko 	 * Remote RX channel is under control of Remote CPU core, so
851d7024191SGrygorii Strashko 	 * Linux can only request and manipulate by dedicated RX flows
852d7024191SGrygorii Strashko 	 */
853d7024191SGrygorii Strashko 
854d7024191SGrygorii Strashko 	rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL);
855d7024191SGrygorii Strashko 	if (!rx_chn)
856d7024191SGrygorii Strashko 		return ERR_PTR(-ENOMEM);
857d7024191SGrygorii Strashko 
858d7024191SGrygorii Strashko 	rx_chn->common.dev = dev;
859d7024191SGrygorii Strashko 	rx_chn->common.swdata_size = cfg->swdata_size;
860d7024191SGrygorii Strashko 	rx_chn->remote = true;
861d7024191SGrygorii Strashko 	rx_chn->udma_rchan_id = -1;
862d7024191SGrygorii Strashko 	rx_chn->flow_num = cfg->flow_id_num;
863d7024191SGrygorii Strashko 	rx_chn->flow_id_base = cfg->flow_id_base;
864d7024191SGrygorii Strashko 	rx_chn->psil_paired = false;
865d7024191SGrygorii Strashko 
866d7024191SGrygorii Strashko 	/* parse of udmap channel */
867d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse_chn(dev->of_node, name,
868d7024191SGrygorii Strashko 					&rx_chn->common, false);
869d7024191SGrygorii Strashko 	if (ret)
870d7024191SGrygorii Strashko 		goto err;
871d7024191SGrygorii Strashko 
872d7024191SGrygorii Strashko 	rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib,
873d7024191SGrygorii Strashko 						rx_chn->common.psdata_size,
874d7024191SGrygorii Strashko 						rx_chn->common.swdata_size);
875d7024191SGrygorii Strashko 
876d7024191SGrygorii Strashko 	rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num,
877d7024191SGrygorii Strashko 				     sizeof(*rx_chn->flows), GFP_KERNEL);
878d7024191SGrygorii Strashko 	if (!rx_chn->flows) {
879d7024191SGrygorii Strashko 		ret = -ENOMEM;
880d7024191SGrygorii Strashko 		goto err;
881d7024191SGrygorii Strashko 	}
882d7024191SGrygorii Strashko 
883d7024191SGrygorii Strashko 	ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg);
884d7024191SGrygorii Strashko 	if (ret)
885d7024191SGrygorii Strashko 		goto err;
886d7024191SGrygorii Strashko 
887d7024191SGrygorii Strashko 	for (i = 0; i < rx_chn->flow_num; i++)
888d7024191SGrygorii Strashko 		rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i;
889d7024191SGrygorii Strashko 
890d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_chn(rx_chn);
891d7024191SGrygorii Strashko 
892d7024191SGrygorii Strashko 	return rx_chn;
893d7024191SGrygorii Strashko 
894d7024191SGrygorii Strashko err:
895d7024191SGrygorii Strashko 	k3_udma_glue_release_rx_chn(rx_chn);
896d7024191SGrygorii Strashko 	return ERR_PTR(ret);
897d7024191SGrygorii Strashko }
898d7024191SGrygorii Strashko 
899d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel *
900d7024191SGrygorii Strashko k3_udma_glue_request_rx_chn(struct device *dev, const char *name,
901d7024191SGrygorii Strashko 			    struct k3_udma_glue_rx_channel_cfg *cfg)
902d7024191SGrygorii Strashko {
903d7024191SGrygorii Strashko 	if (cfg->remote)
904d7024191SGrygorii Strashko 		return k3_udma_glue_request_remote_rx_chn(dev, name, cfg);
905d7024191SGrygorii Strashko 	else
906d7024191SGrygorii Strashko 		return k3_udma_glue_request_rx_chn_priv(dev, name, cfg);
907d7024191SGrygorii Strashko }
908d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_request_rx_chn);
909d7024191SGrygorii Strashko 
910d7024191SGrygorii Strashko void k3_udma_glue_release_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
911d7024191SGrygorii Strashko {
912d7024191SGrygorii Strashko 	int i;
913d7024191SGrygorii Strashko 
914d7024191SGrygorii Strashko 	if (IS_ERR_OR_NULL(rx_chn->common.udmax))
915d7024191SGrygorii Strashko 		return;
916d7024191SGrygorii Strashko 
917d7024191SGrygorii Strashko 	if (rx_chn->psil_paired) {
918d7024191SGrygorii Strashko 		xudma_navss_psil_unpair(rx_chn->common.udmax,
919d7024191SGrygorii Strashko 					rx_chn->common.src_thread,
920d7024191SGrygorii Strashko 					rx_chn->common.dst_thread);
921d7024191SGrygorii Strashko 		rx_chn->psil_paired = false;
922d7024191SGrygorii Strashko 	}
923d7024191SGrygorii Strashko 
924d7024191SGrygorii Strashko 	for (i = 0; i < rx_chn->flow_num; i++)
925d7024191SGrygorii Strashko 		k3_udma_glue_release_rx_flow(rx_chn, i);
926d7024191SGrygorii Strashko 
927d7024191SGrygorii Strashko 	if (xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base))
928d7024191SGrygorii Strashko 		xudma_free_gp_rflow_range(rx_chn->common.udmax,
929d7024191SGrygorii Strashko 					  rx_chn->flow_id_base,
930d7024191SGrygorii Strashko 					  rx_chn->flow_num);
931d7024191SGrygorii Strashko 
932d7024191SGrygorii Strashko 	if (!IS_ERR_OR_NULL(rx_chn->udma_rchanx))
933d7024191SGrygorii Strashko 		xudma_rchan_put(rx_chn->common.udmax,
934d7024191SGrygorii Strashko 				rx_chn->udma_rchanx);
935d7024191SGrygorii Strashko }
936d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_release_rx_chn);
937d7024191SGrygorii Strashko 
938d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_init(struct k3_udma_glue_rx_channel *rx_chn,
939d7024191SGrygorii Strashko 			      u32 flow_idx,
940d7024191SGrygorii Strashko 			      struct k3_udma_glue_rx_flow_cfg *flow_cfg)
941d7024191SGrygorii Strashko {
942d7024191SGrygorii Strashko 	if (flow_idx >= rx_chn->flow_num)
943d7024191SGrygorii Strashko 		return -EINVAL;
944d7024191SGrygorii Strashko 
945d7024191SGrygorii Strashko 	return k3_udma_glue_cfg_rx_flow(rx_chn, flow_idx, flow_cfg);
946d7024191SGrygorii Strashko }
947d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_init);
948d7024191SGrygorii Strashko 
949d7024191SGrygorii Strashko u32 k3_udma_glue_rx_flow_get_fdq_id(struct k3_udma_glue_rx_channel *rx_chn,
950d7024191SGrygorii Strashko 				    u32 flow_idx)
951d7024191SGrygorii Strashko {
952d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow;
953d7024191SGrygorii Strashko 
954d7024191SGrygorii Strashko 	if (flow_idx >= rx_chn->flow_num)
955d7024191SGrygorii Strashko 		return -EINVAL;
956d7024191SGrygorii Strashko 
957d7024191SGrygorii Strashko 	flow = &rx_chn->flows[flow_idx];
958d7024191SGrygorii Strashko 
959d7024191SGrygorii Strashko 	return k3_ringacc_get_ring_id(flow->ringrxfdq);
960d7024191SGrygorii Strashko }
961d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_get_fdq_id);
962d7024191SGrygorii Strashko 
963d7024191SGrygorii Strashko u32 k3_udma_glue_rx_get_flow_id_base(struct k3_udma_glue_rx_channel *rx_chn)
964d7024191SGrygorii Strashko {
965d7024191SGrygorii Strashko 	return rx_chn->flow_id_base;
966d7024191SGrygorii Strashko }
967d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_flow_id_base);
968d7024191SGrygorii Strashko 
969d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_enable(struct k3_udma_glue_rx_channel *rx_chn,
970d7024191SGrygorii Strashko 				u32 flow_idx)
971d7024191SGrygorii Strashko {
972d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx];
973d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
974d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
975d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_flow_cfg req;
976d7024191SGrygorii Strashko 	int rx_ring_id;
977d7024191SGrygorii Strashko 	int rx_ringfdq_id;
978d7024191SGrygorii Strashko 	int ret = 0;
979d7024191SGrygorii Strashko 
980d7024191SGrygorii Strashko 	if (!rx_chn->remote)
981d7024191SGrygorii Strashko 		return -EINVAL;
982d7024191SGrygorii Strashko 
983d7024191SGrygorii Strashko 	rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx);
984d7024191SGrygorii Strashko 	rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq);
985d7024191SGrygorii Strashko 
986d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
987d7024191SGrygorii Strashko 
988d7024191SGrygorii Strashko 	req.valid_params =
989d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID |
990d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID |
991d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID |
992d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID |
993d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID;
994d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
995d7024191SGrygorii Strashko 	req.flow_index = flow->udma_rflow_id;
996d7024191SGrygorii Strashko 	req.rx_dest_qnum = rx_ring_id;
997d7024191SGrygorii Strashko 	req.rx_fdq0_sz0_qnum = rx_ringfdq_id;
998d7024191SGrygorii Strashko 	req.rx_fdq1_qnum = rx_ringfdq_id;
999d7024191SGrygorii Strashko 	req.rx_fdq2_qnum = rx_ringfdq_id;
1000d7024191SGrygorii Strashko 	req.rx_fdq3_qnum = rx_ringfdq_id;
1001d7024191SGrygorii Strashko 
1002d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req);
1003d7024191SGrygorii Strashko 	if (ret) {
1004d7024191SGrygorii Strashko 		dev_err(dev, "flow%d enable failed: %d\n", flow->udma_rflow_id,
1005d7024191SGrygorii Strashko 			ret);
1006d7024191SGrygorii Strashko 	}
1007d7024191SGrygorii Strashko 
1008d7024191SGrygorii Strashko 	return ret;
1009d7024191SGrygorii Strashko }
1010d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_enable);
1011d7024191SGrygorii Strashko 
1012d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_disable(struct k3_udma_glue_rx_channel *rx_chn,
1013d7024191SGrygorii Strashko 				 u32 flow_idx)
1014d7024191SGrygorii Strashko {
1015d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx];
1016d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
1017d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
1018d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_flow_cfg req;
1019d7024191SGrygorii Strashko 	int ret = 0;
1020d7024191SGrygorii Strashko 
1021d7024191SGrygorii Strashko 	if (!rx_chn->remote)
1022d7024191SGrygorii Strashko 		return -EINVAL;
1023d7024191SGrygorii Strashko 
1024d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
1025d7024191SGrygorii Strashko 	req.valid_params =
1026d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID |
1027d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID |
1028d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID |
1029d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID |
1030d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID;
1031d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
1032d7024191SGrygorii Strashko 	req.flow_index = flow->udma_rflow_id;
1033d7024191SGrygorii Strashko 	req.rx_dest_qnum = TI_SCI_RESOURCE_NULL;
1034d7024191SGrygorii Strashko 	req.rx_fdq0_sz0_qnum = TI_SCI_RESOURCE_NULL;
1035d7024191SGrygorii Strashko 	req.rx_fdq1_qnum = TI_SCI_RESOURCE_NULL;
1036d7024191SGrygorii Strashko 	req.rx_fdq2_qnum = TI_SCI_RESOURCE_NULL;
1037d7024191SGrygorii Strashko 	req.rx_fdq3_qnum = TI_SCI_RESOURCE_NULL;
1038d7024191SGrygorii Strashko 
1039d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req);
1040d7024191SGrygorii Strashko 	if (ret) {
1041d7024191SGrygorii Strashko 		dev_err(dev, "flow%d disable failed: %d\n", flow->udma_rflow_id,
1042d7024191SGrygorii Strashko 			ret);
1043d7024191SGrygorii Strashko 	}
1044d7024191SGrygorii Strashko 
1045d7024191SGrygorii Strashko 	return ret;
1046d7024191SGrygorii Strashko }
1047d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_disable);
1048d7024191SGrygorii Strashko 
1049d7024191SGrygorii Strashko int k3_udma_glue_enable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
1050d7024191SGrygorii Strashko {
105169973b48SGrygorii Strashko 	int ret;
105269973b48SGrygorii Strashko 
1053d7024191SGrygorii Strashko 	if (rx_chn->remote)
1054d7024191SGrygorii Strashko 		return -EINVAL;
1055d7024191SGrygorii Strashko 
1056d7024191SGrygorii Strashko 	if (rx_chn->flows_ready < rx_chn->flow_num)
1057d7024191SGrygorii Strashko 		return -EINVAL;
1058d7024191SGrygorii Strashko 
105969973b48SGrygorii Strashko 	ret = xudma_navss_psil_pair(rx_chn->common.udmax,
106069973b48SGrygorii Strashko 				    rx_chn->common.src_thread,
106169973b48SGrygorii Strashko 				    rx_chn->common.dst_thread);
106269973b48SGrygorii Strashko 	if (ret) {
106369973b48SGrygorii Strashko 		dev_err(rx_chn->common.dev, "PSI-L request err %d\n", ret);
106469973b48SGrygorii Strashko 		return ret;
106569973b48SGrygorii Strashko 	}
106669973b48SGrygorii Strashko 
106769973b48SGrygorii Strashko 	rx_chn->psil_paired = true;
106869973b48SGrygorii Strashko 
1069bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG,
107052c74d3dSGrygorii Strashko 			    UDMA_CHAN_RT_CTL_EN);
1071d7024191SGrygorii Strashko 
1072bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG,
1073d7024191SGrygorii Strashko 			    UDMA_PEER_RT_EN_ENABLE);
1074d7024191SGrygorii Strashko 
1075d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt en");
1076d7024191SGrygorii Strashko 	return 0;
1077d7024191SGrygorii Strashko }
1078d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_enable_rx_chn);
1079d7024191SGrygorii Strashko 
1080d7024191SGrygorii Strashko void k3_udma_glue_disable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
1081d7024191SGrygorii Strashko {
1082d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis1");
1083d7024191SGrygorii Strashko 
1084d7024191SGrygorii Strashko 	xudma_rchanrt_write(rx_chn->udma_rchanx,
1085bc7e5523SPeter Ujfalusi 			    UDMA_CHAN_RT_PEER_RT_EN_REG, 0);
1086bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG, 0);
1087d7024191SGrygorii Strashko 
1088d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis2");
108969973b48SGrygorii Strashko 
109069973b48SGrygorii Strashko 	if (rx_chn->psil_paired) {
109169973b48SGrygorii Strashko 		xudma_navss_psil_unpair(rx_chn->common.udmax,
109269973b48SGrygorii Strashko 					rx_chn->common.src_thread,
109369973b48SGrygorii Strashko 					rx_chn->common.dst_thread);
109469973b48SGrygorii Strashko 		rx_chn->psil_paired = false;
109569973b48SGrygorii Strashko 	}
1096d7024191SGrygorii Strashko }
1097d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_disable_rx_chn);
1098d7024191SGrygorii Strashko 
1099d7024191SGrygorii Strashko void k3_udma_glue_tdown_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1100d7024191SGrygorii Strashko 			       bool sync)
1101d7024191SGrygorii Strashko {
1102d7024191SGrygorii Strashko 	int i = 0;
1103d7024191SGrygorii Strashko 	u32 val;
1104d7024191SGrygorii Strashko 
1105d7024191SGrygorii Strashko 	if (rx_chn->remote)
1106d7024191SGrygorii Strashko 		return;
1107d7024191SGrygorii Strashko 
1108d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown1");
1109d7024191SGrygorii Strashko 
1110bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG,
1111d7024191SGrygorii Strashko 			    UDMA_PEER_RT_EN_ENABLE | UDMA_PEER_RT_EN_TEARDOWN);
1112d7024191SGrygorii Strashko 
1113bc7e5523SPeter Ujfalusi 	val = xudma_rchanrt_read(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG);
1114d7024191SGrygorii Strashko 
1115d7024191SGrygorii Strashko 	while (sync && (val & UDMA_CHAN_RT_CTL_EN)) {
1116d7024191SGrygorii Strashko 		val = xudma_rchanrt_read(rx_chn->udma_rchanx,
1117bc7e5523SPeter Ujfalusi 					 UDMA_CHAN_RT_CTL_REG);
1118d7024191SGrygorii Strashko 		udelay(1);
1119d7024191SGrygorii Strashko 		if (i > K3_UDMAX_TDOWN_TIMEOUT_US) {
1120d7024191SGrygorii Strashko 			dev_err(rx_chn->common.dev, "RX tdown timeout\n");
1121d7024191SGrygorii Strashko 			break;
1122d7024191SGrygorii Strashko 		}
1123d7024191SGrygorii Strashko 		i++;
1124d7024191SGrygorii Strashko 	}
1125d7024191SGrygorii Strashko 
1126d7024191SGrygorii Strashko 	val = xudma_rchanrt_read(rx_chn->udma_rchanx,
1127bc7e5523SPeter Ujfalusi 				 UDMA_CHAN_RT_PEER_RT_EN_REG);
1128d7024191SGrygorii Strashko 	if (sync && (val & UDMA_PEER_RT_EN_ENABLE))
1129d7024191SGrygorii Strashko 		dev_err(rx_chn->common.dev, "TX tdown peer not stopped\n");
1130d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown2");
1131d7024191SGrygorii Strashko }
1132d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tdown_rx_chn);
1133d7024191SGrygorii Strashko 
1134d7024191SGrygorii Strashko void k3_udma_glue_reset_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1135d7024191SGrygorii Strashko 		u32 flow_num, void *data,
1136d7024191SGrygorii Strashko 		void (*cleanup)(void *data, dma_addr_t desc_dma), bool skip_fdq)
1137d7024191SGrygorii Strashko {
1138d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
1139d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
1140d7024191SGrygorii Strashko 	dma_addr_t desc_dma;
1141d7024191SGrygorii Strashko 	int occ_rx, i, ret;
1142d7024191SGrygorii Strashko 
1143d7024191SGrygorii Strashko 	/* reset RXCQ as it is not input for udma - expected to be empty */
1144d7024191SGrygorii Strashko 	occ_rx = k3_ringacc_ring_get_occ(flow->ringrx);
1145d7024191SGrygorii Strashko 	dev_dbg(dev, "RX reset flow %u occ_rx %u\n", flow_num, occ_rx);
1146d7024191SGrygorii Strashko 	if (flow->ringrx)
1147d7024191SGrygorii Strashko 		k3_ringacc_ring_reset(flow->ringrx);
1148d7024191SGrygorii Strashko 
1149d7024191SGrygorii Strashko 	/* Skip RX FDQ in case one FDQ is used for the set of flows */
1150d7024191SGrygorii Strashko 	if (skip_fdq)
1151d7024191SGrygorii Strashko 		return;
1152d7024191SGrygorii Strashko 
1153d7024191SGrygorii Strashko 	/*
1154d7024191SGrygorii Strashko 	 * RX FDQ reset need to be special way as it is input for udma and its
1155d7024191SGrygorii Strashko 	 * state cached by udma, so:
1156d7024191SGrygorii Strashko 	 * 1) save RX FDQ occ
1157d7024191SGrygorii Strashko 	 * 2) clean up RX FDQ and call callback .cleanup() for each desc
1158d7024191SGrygorii Strashko 	 * 3) reset RX FDQ in a special way
1159d7024191SGrygorii Strashko 	 */
1160d7024191SGrygorii Strashko 	occ_rx = k3_ringacc_ring_get_occ(flow->ringrxfdq);
1161d7024191SGrygorii Strashko 	dev_dbg(dev, "RX reset flow %u occ_rx_fdq %u\n", flow_num, occ_rx);
1162d7024191SGrygorii Strashko 
1163d7024191SGrygorii Strashko 	for (i = 0; i < occ_rx; i++) {
1164d7024191SGrygorii Strashko 		ret = k3_ringacc_ring_pop(flow->ringrxfdq, &desc_dma);
1165d7024191SGrygorii Strashko 		if (ret) {
1166d7024191SGrygorii Strashko 			dev_err(dev, "RX reset pop %d\n", ret);
1167d7024191SGrygorii Strashko 			break;
1168d7024191SGrygorii Strashko 		}
1169d7024191SGrygorii Strashko 		cleanup(data, desc_dma);
1170d7024191SGrygorii Strashko 	}
1171d7024191SGrygorii Strashko 
1172d7024191SGrygorii Strashko 	k3_ringacc_ring_reset_dma(flow->ringrxfdq, occ_rx);
1173d7024191SGrygorii Strashko }
1174d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_reset_rx_chn);
1175d7024191SGrygorii Strashko 
1176d7024191SGrygorii Strashko int k3_udma_glue_push_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1177d7024191SGrygorii Strashko 			     u32 flow_num, struct cppi5_host_desc_t *desc_rx,
1178d7024191SGrygorii Strashko 			     dma_addr_t desc_dma)
1179d7024191SGrygorii Strashko {
1180d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
1181d7024191SGrygorii Strashko 
1182d7024191SGrygorii Strashko 	return k3_ringacc_ring_push(flow->ringrxfdq, &desc_dma);
1183d7024191SGrygorii Strashko }
1184d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_push_rx_chn);
1185d7024191SGrygorii Strashko 
1186d7024191SGrygorii Strashko int k3_udma_glue_pop_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1187d7024191SGrygorii Strashko 			    u32 flow_num, dma_addr_t *desc_dma)
1188d7024191SGrygorii Strashko {
1189d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
1190d7024191SGrygorii Strashko 
1191d7024191SGrygorii Strashko 	return k3_ringacc_ring_pop(flow->ringrx, desc_dma);
1192d7024191SGrygorii Strashko }
1193d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_pop_rx_chn);
1194d7024191SGrygorii Strashko 
1195d7024191SGrygorii Strashko int k3_udma_glue_rx_get_irq(struct k3_udma_glue_rx_channel *rx_chn,
1196d7024191SGrygorii Strashko 			    u32 flow_num)
1197d7024191SGrygorii Strashko {
1198d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow;
1199d7024191SGrygorii Strashko 
1200d7024191SGrygorii Strashko 	flow = &rx_chn->flows[flow_num];
1201d7024191SGrygorii Strashko 
1202d7024191SGrygorii Strashko 	flow->virq = k3_ringacc_get_ring_irq_num(flow->ringrx);
1203d7024191SGrygorii Strashko 
1204d7024191SGrygorii Strashko 	return flow->virq;
1205d7024191SGrygorii Strashko }
1206d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_irq);
1207426506a7SPeter Ujfalusi 
1208426506a7SPeter Ujfalusi struct device *
1209426506a7SPeter Ujfalusi 	k3_udma_glue_rx_get_dma_device(struct k3_udma_glue_rx_channel *rx_chn)
1210426506a7SPeter Ujfalusi {
1211426506a7SPeter Ujfalusi 	return xudma_get_device(rx_chn->common.udmax);
1212426506a7SPeter Ujfalusi }
1213426506a7SPeter Ujfalusi EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_dma_device);
1214