xref: /openbmc/linux/drivers/dma/ti/k3-udma-glue.c (revision 52c74d3d356b60f3c53dc69e5109752347e144e8)
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->ringacc = of_k3_ringacc_get_by_phandle(udmax_np,
90d7024191SGrygorii Strashko 						       "ti,ringacc");
91d7024191SGrygorii Strashko 	if (IS_ERR(common->ringacc))
92d7024191SGrygorii Strashko 		return PTR_ERR(common->ringacc);
93d7024191SGrygorii Strashko 
94d7024191SGrygorii Strashko 	common->udmax = of_xudma_dev_get(udmax_np, NULL);
95d7024191SGrygorii Strashko 	if (IS_ERR(common->udmax))
96d7024191SGrygorii Strashko 		return PTR_ERR(common->udmax);
97d7024191SGrygorii Strashko 
98d7024191SGrygorii Strashko 	common->tisci_rm = xudma_dev_get_tisci_rm(common->udmax);
99d7024191SGrygorii Strashko 
100d7024191SGrygorii Strashko 	return 0;
101d7024191SGrygorii Strashko }
102d7024191SGrygorii Strashko 
103d7024191SGrygorii Strashko static int of_k3_udma_glue_parse_chn(struct device_node *chn_np,
104d7024191SGrygorii Strashko 		const char *name, struct k3_udma_glue_common *common,
105d7024191SGrygorii Strashko 		bool tx_chn)
106d7024191SGrygorii Strashko {
107d7024191SGrygorii Strashko 	struct psil_endpoint_config *ep_config;
108d7024191SGrygorii Strashko 	struct of_phandle_args dma_spec;
109d7024191SGrygorii Strashko 	u32 thread_id;
110d7024191SGrygorii Strashko 	int ret = 0;
111d7024191SGrygorii Strashko 	int index;
112d7024191SGrygorii Strashko 
113d7024191SGrygorii Strashko 	if (unlikely(!name))
114d7024191SGrygorii Strashko 		return -EINVAL;
115d7024191SGrygorii Strashko 
116d7024191SGrygorii Strashko 	index = of_property_match_string(chn_np, "dma-names", name);
117d7024191SGrygorii Strashko 	if (index < 0)
118d7024191SGrygorii Strashko 		return index;
119d7024191SGrygorii Strashko 
120d7024191SGrygorii Strashko 	if (of_parse_phandle_with_args(chn_np, "dmas", "#dma-cells", index,
121d7024191SGrygorii Strashko 				       &dma_spec))
122d7024191SGrygorii Strashko 		return -ENOENT;
123d7024191SGrygorii Strashko 
124d7024191SGrygorii Strashko 	thread_id = dma_spec.args[0];
1250ebcf1a2SPeter Ujfalusi 	if (dma_spec.args_count == 2) {
1260ebcf1a2SPeter Ujfalusi 		if (dma_spec.args[1] > 2) {
1270ebcf1a2SPeter Ujfalusi 			dev_err(common->dev, "Invalid channel atype: %u\n",
1280ebcf1a2SPeter Ujfalusi 				dma_spec.args[1]);
1290ebcf1a2SPeter Ujfalusi 			ret = -EINVAL;
1300ebcf1a2SPeter Ujfalusi 			goto out_put_spec;
1310ebcf1a2SPeter Ujfalusi 		}
1320ebcf1a2SPeter Ujfalusi 		common->atype = dma_spec.args[1];
1330ebcf1a2SPeter Ujfalusi 	}
134d7024191SGrygorii Strashko 
135d7024191SGrygorii Strashko 	if (tx_chn && !(thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) {
136d7024191SGrygorii Strashko 		ret = -EINVAL;
137d7024191SGrygorii Strashko 		goto out_put_spec;
138d7024191SGrygorii Strashko 	}
139d7024191SGrygorii Strashko 
140d7024191SGrygorii Strashko 	if (!tx_chn && (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) {
141d7024191SGrygorii Strashko 		ret = -EINVAL;
142d7024191SGrygorii Strashko 		goto out_put_spec;
143d7024191SGrygorii Strashko 	}
144d7024191SGrygorii Strashko 
145d7024191SGrygorii Strashko 	/* get psil endpoint config */
146d7024191SGrygorii Strashko 	ep_config = psil_get_ep_config(thread_id);
147d7024191SGrygorii Strashko 	if (IS_ERR(ep_config)) {
148d7024191SGrygorii Strashko 		dev_err(common->dev,
149d7024191SGrygorii Strashko 			"No configuration for psi-l thread 0x%04x\n",
150d7024191SGrygorii Strashko 			thread_id);
151d7024191SGrygorii Strashko 		ret = PTR_ERR(ep_config);
152d7024191SGrygorii Strashko 		goto out_put_spec;
153d7024191SGrygorii Strashko 	}
154d7024191SGrygorii Strashko 
155d7024191SGrygorii Strashko 	common->epib = ep_config->needs_epib;
156d7024191SGrygorii Strashko 	common->psdata_size = ep_config->psd_size;
157d7024191SGrygorii Strashko 
158d7024191SGrygorii Strashko 	if (tx_chn)
159d7024191SGrygorii Strashko 		common->dst_thread = thread_id;
160d7024191SGrygorii Strashko 	else
161d7024191SGrygorii Strashko 		common->src_thread = thread_id;
162d7024191SGrygorii Strashko 
163d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse(dma_spec.np, common);
164d7024191SGrygorii Strashko 
165d7024191SGrygorii Strashko out_put_spec:
166d7024191SGrygorii Strashko 	of_node_put(dma_spec.np);
167d7024191SGrygorii Strashko 	return ret;
168d7024191SGrygorii Strashko };
169d7024191SGrygorii Strashko 
170d7024191SGrygorii Strashko static void k3_udma_glue_dump_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
171d7024191SGrygorii Strashko {
172d7024191SGrygorii Strashko 	struct device *dev = tx_chn->common.dev;
173d7024191SGrygorii Strashko 
174d7024191SGrygorii Strashko 	dev_dbg(dev, "dump_tx_chn:\n"
175d7024191SGrygorii Strashko 		"udma_tchan_id: %d\n"
176d7024191SGrygorii Strashko 		"src_thread: %08x\n"
177d7024191SGrygorii Strashko 		"dst_thread: %08x\n",
178d7024191SGrygorii Strashko 		tx_chn->udma_tchan_id,
179d7024191SGrygorii Strashko 		tx_chn->common.src_thread,
180d7024191SGrygorii Strashko 		tx_chn->common.dst_thread);
181d7024191SGrygorii Strashko }
182d7024191SGrygorii Strashko 
183d7024191SGrygorii Strashko static void k3_udma_glue_dump_tx_rt_chn(struct k3_udma_glue_tx_channel *chn,
184d7024191SGrygorii Strashko 					char *mark)
185d7024191SGrygorii Strashko {
186d7024191SGrygorii Strashko 	struct device *dev = chn->common.dev;
187d7024191SGrygorii Strashko 
188d7024191SGrygorii Strashko 	dev_dbg(dev, "=== dump ===> %s\n", mark);
189bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG,
190bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG));
191bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG,
192d7024191SGrygorii Strashko 		xudma_tchanrt_read(chn->udma_tchanx,
193bc7e5523SPeter Ujfalusi 				   UDMA_CHAN_RT_PEER_RT_EN_REG));
194bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG,
195bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_PCNT_REG));
196bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG,
197bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_BCNT_REG));
198bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG,
199bc7e5523SPeter Ujfalusi 		xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_SBCNT_REG));
200d7024191SGrygorii Strashko }
201d7024191SGrygorii Strashko 
202d7024191SGrygorii Strashko static int k3_udma_glue_cfg_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
203d7024191SGrygorii Strashko {
204d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = tx_chn->common.tisci_rm;
205d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_tx_ch_cfg req;
206d7024191SGrygorii Strashko 
207d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
208d7024191SGrygorii Strashko 
209d7024191SGrygorii Strashko 	req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_PAUSE_ON_ERR_VALID |
210d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_EINFO_VALID |
211d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_PSWORDS_VALID |
212d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID |
213d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_SUPR_TDPKT_VALID |
214d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID |
2150ebcf1a2SPeter Ujfalusi 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID |
2160ebcf1a2SPeter Ujfalusi 			TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID;
217d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
218d7024191SGrygorii Strashko 	req.index = tx_chn->udma_tchan_id;
219d7024191SGrygorii Strashko 	if (tx_chn->tx_pause_on_err)
220d7024191SGrygorii Strashko 		req.tx_pause_on_err = 1;
221d7024191SGrygorii Strashko 	if (tx_chn->tx_filt_einfo)
222d7024191SGrygorii Strashko 		req.tx_filt_einfo = 1;
223d7024191SGrygorii Strashko 	if (tx_chn->tx_filt_pswords)
224d7024191SGrygorii Strashko 		req.tx_filt_pswords = 1;
225d7024191SGrygorii Strashko 	req.tx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR;
226d7024191SGrygorii Strashko 	if (tx_chn->tx_supr_tdpkt)
227d7024191SGrygorii Strashko 		req.tx_supr_tdpkt = 1;
228d7024191SGrygorii Strashko 	req.tx_fetch_size = tx_chn->common.hdesc_size >> 2;
229d7024191SGrygorii Strashko 	req.txcq_qnum = k3_ringacc_get_ring_id(tx_chn->ringtxcq);
2300ebcf1a2SPeter Ujfalusi 	req.tx_atype = tx_chn->common.atype;
231d7024191SGrygorii Strashko 
232d7024191SGrygorii Strashko 	return tisci_rm->tisci_udmap_ops->tx_ch_cfg(tisci_rm->tisci, &req);
233d7024191SGrygorii Strashko }
234d7024191SGrygorii Strashko 
235d7024191SGrygorii Strashko struct k3_udma_glue_tx_channel *k3_udma_glue_request_tx_chn(struct device *dev,
236d7024191SGrygorii Strashko 		const char *name, struct k3_udma_glue_tx_channel_cfg *cfg)
237d7024191SGrygorii Strashko {
238d7024191SGrygorii Strashko 	struct k3_udma_glue_tx_channel *tx_chn;
239d7024191SGrygorii Strashko 	int ret;
240d7024191SGrygorii Strashko 
241d7024191SGrygorii Strashko 	tx_chn = devm_kzalloc(dev, sizeof(*tx_chn), GFP_KERNEL);
242d7024191SGrygorii Strashko 	if (!tx_chn)
243d7024191SGrygorii Strashko 		return ERR_PTR(-ENOMEM);
244d7024191SGrygorii Strashko 
245d7024191SGrygorii Strashko 	tx_chn->common.dev = dev;
246d7024191SGrygorii Strashko 	tx_chn->common.swdata_size = cfg->swdata_size;
247d7024191SGrygorii Strashko 	tx_chn->tx_pause_on_err = cfg->tx_pause_on_err;
248d7024191SGrygorii Strashko 	tx_chn->tx_filt_einfo = cfg->tx_filt_einfo;
249d7024191SGrygorii Strashko 	tx_chn->tx_filt_pswords = cfg->tx_filt_pswords;
250d7024191SGrygorii Strashko 	tx_chn->tx_supr_tdpkt = cfg->tx_supr_tdpkt;
251d7024191SGrygorii Strashko 
252d7024191SGrygorii Strashko 	/* parse of udmap channel */
253d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse_chn(dev->of_node, name,
254d7024191SGrygorii Strashko 					&tx_chn->common, true);
255d7024191SGrygorii Strashko 	if (ret)
256d7024191SGrygorii Strashko 		goto err;
257d7024191SGrygorii Strashko 
258d7024191SGrygorii Strashko 	tx_chn->common.hdesc_size = cppi5_hdesc_calc_size(tx_chn->common.epib,
259d7024191SGrygorii Strashko 						tx_chn->common.psdata_size,
260d7024191SGrygorii Strashko 						tx_chn->common.swdata_size);
261d7024191SGrygorii Strashko 
262d7024191SGrygorii Strashko 	/* request and cfg UDMAP TX channel */
263d7024191SGrygorii Strashko 	tx_chn->udma_tchanx = xudma_tchan_get(tx_chn->common.udmax, -1);
264d7024191SGrygorii Strashko 	if (IS_ERR(tx_chn->udma_tchanx)) {
265d7024191SGrygorii Strashko 		ret = PTR_ERR(tx_chn->udma_tchanx);
266d7024191SGrygorii Strashko 		dev_err(dev, "UDMAX tchanx get err %d\n", ret);
267d7024191SGrygorii Strashko 		goto err;
268d7024191SGrygorii Strashko 	}
269d7024191SGrygorii Strashko 	tx_chn->udma_tchan_id = xudma_tchan_get_id(tx_chn->udma_tchanx);
270d7024191SGrygorii Strashko 
271d7024191SGrygorii Strashko 	atomic_set(&tx_chn->free_pkts, cfg->txcq_cfg.size);
272d7024191SGrygorii Strashko 
273d7024191SGrygorii Strashko 	/* request and cfg rings */
2744927b1abSPeter Ujfalusi 	ret =  k3_ringacc_request_rings_pair(tx_chn->common.ringacc,
2754927b1abSPeter Ujfalusi 					     tx_chn->udma_tchan_id, -1,
2764927b1abSPeter Ujfalusi 					     &tx_chn->ringtx,
2774927b1abSPeter Ujfalusi 					     &tx_chn->ringtxcq);
2784927b1abSPeter Ujfalusi 	if (ret) {
2794927b1abSPeter Ujfalusi 		dev_err(dev, "Failed to get TX/TXCQ rings %d\n", ret);
280d7024191SGrygorii Strashko 		goto err;
281d7024191SGrygorii Strashko 	}
282d7024191SGrygorii Strashko 
283d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(tx_chn->ringtx, &cfg->tx_cfg);
284d7024191SGrygorii Strashko 	if (ret) {
285d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringtx %d\n", ret);
286d7024191SGrygorii Strashko 		goto err;
287d7024191SGrygorii Strashko 	}
288d7024191SGrygorii Strashko 
289d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(tx_chn->ringtxcq, &cfg->txcq_cfg);
290d7024191SGrygorii Strashko 	if (ret) {
291d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringtx %d\n", ret);
292d7024191SGrygorii Strashko 		goto err;
293d7024191SGrygorii Strashko 	}
294d7024191SGrygorii Strashko 
295d7024191SGrygorii Strashko 	/* request and cfg psi-l */
296d7024191SGrygorii Strashko 	tx_chn->common.src_thread =
297d7024191SGrygorii Strashko 			xudma_dev_get_psil_base(tx_chn->common.udmax) +
298d7024191SGrygorii Strashko 			tx_chn->udma_tchan_id;
299d7024191SGrygorii Strashko 
300d7024191SGrygorii Strashko 	ret = k3_udma_glue_cfg_tx_chn(tx_chn);
301d7024191SGrygorii Strashko 	if (ret) {
302d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg tchan %d\n", ret);
303d7024191SGrygorii Strashko 		goto err;
304d7024191SGrygorii Strashko 	}
305d7024191SGrygorii Strashko 
306d7024191SGrygorii Strashko 	ret = xudma_navss_psil_pair(tx_chn->common.udmax,
307d7024191SGrygorii Strashko 				    tx_chn->common.src_thread,
308d7024191SGrygorii Strashko 				    tx_chn->common.dst_thread);
309d7024191SGrygorii Strashko 	if (ret) {
310d7024191SGrygorii Strashko 		dev_err(dev, "PSI-L request err %d\n", ret);
311d7024191SGrygorii Strashko 		goto err;
312d7024191SGrygorii Strashko 	}
313d7024191SGrygorii Strashko 
314d7024191SGrygorii Strashko 	tx_chn->psil_paired = true;
315d7024191SGrygorii Strashko 
316d7024191SGrygorii Strashko 	/* reset TX RT registers */
317d7024191SGrygorii Strashko 	k3_udma_glue_disable_tx_chn(tx_chn);
318d7024191SGrygorii Strashko 
319d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_chn(tx_chn);
320d7024191SGrygorii Strashko 
321d7024191SGrygorii Strashko 	return tx_chn;
322d7024191SGrygorii Strashko 
323d7024191SGrygorii Strashko err:
324d7024191SGrygorii Strashko 	k3_udma_glue_release_tx_chn(tx_chn);
325d7024191SGrygorii Strashko 	return ERR_PTR(ret);
326d7024191SGrygorii Strashko }
327d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_request_tx_chn);
328d7024191SGrygorii Strashko 
329d7024191SGrygorii Strashko void k3_udma_glue_release_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
330d7024191SGrygorii Strashko {
331d7024191SGrygorii Strashko 	if (tx_chn->psil_paired) {
332d7024191SGrygorii Strashko 		xudma_navss_psil_unpair(tx_chn->common.udmax,
333d7024191SGrygorii Strashko 					tx_chn->common.src_thread,
334d7024191SGrygorii Strashko 					tx_chn->common.dst_thread);
335d7024191SGrygorii Strashko 		tx_chn->psil_paired = false;
336d7024191SGrygorii Strashko 	}
337d7024191SGrygorii Strashko 
338d7024191SGrygorii Strashko 	if (!IS_ERR_OR_NULL(tx_chn->udma_tchanx))
339d7024191SGrygorii Strashko 		xudma_tchan_put(tx_chn->common.udmax,
340d7024191SGrygorii Strashko 				tx_chn->udma_tchanx);
341d7024191SGrygorii Strashko 
342d7024191SGrygorii Strashko 	if (tx_chn->ringtxcq)
343d7024191SGrygorii Strashko 		k3_ringacc_ring_free(tx_chn->ringtxcq);
344d7024191SGrygorii Strashko 
345d7024191SGrygorii Strashko 	if (tx_chn->ringtx)
346d7024191SGrygorii Strashko 		k3_ringacc_ring_free(tx_chn->ringtx);
347d7024191SGrygorii Strashko }
348d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_release_tx_chn);
349d7024191SGrygorii Strashko 
350d7024191SGrygorii Strashko int k3_udma_glue_push_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
351d7024191SGrygorii Strashko 			     struct cppi5_host_desc_t *desc_tx,
352d7024191SGrygorii Strashko 			     dma_addr_t desc_dma)
353d7024191SGrygorii Strashko {
354d7024191SGrygorii Strashko 	u32 ringtxcq_id;
355d7024191SGrygorii Strashko 
356d7024191SGrygorii Strashko 	if (!atomic_add_unless(&tx_chn->free_pkts, -1, 0))
357d7024191SGrygorii Strashko 		return -ENOMEM;
358d7024191SGrygorii Strashko 
359d7024191SGrygorii Strashko 	ringtxcq_id = k3_ringacc_get_ring_id(tx_chn->ringtxcq);
360d7024191SGrygorii Strashko 	cppi5_desc_set_retpolicy(&desc_tx->hdr, 0, ringtxcq_id);
361d7024191SGrygorii Strashko 
362d7024191SGrygorii Strashko 	return k3_ringacc_ring_push(tx_chn->ringtx, &desc_dma);
363d7024191SGrygorii Strashko }
364d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_push_tx_chn);
365d7024191SGrygorii Strashko 
366d7024191SGrygorii Strashko int k3_udma_glue_pop_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
367d7024191SGrygorii Strashko 			    dma_addr_t *desc_dma)
368d7024191SGrygorii Strashko {
369d7024191SGrygorii Strashko 	int ret;
370d7024191SGrygorii Strashko 
371d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_pop(tx_chn->ringtxcq, desc_dma);
372d7024191SGrygorii Strashko 	if (!ret)
373d7024191SGrygorii Strashko 		atomic_inc(&tx_chn->free_pkts);
374d7024191SGrygorii Strashko 
375d7024191SGrygorii Strashko 	return ret;
376d7024191SGrygorii Strashko }
377d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_pop_tx_chn);
378d7024191SGrygorii Strashko 
379d7024191SGrygorii Strashko int k3_udma_glue_enable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
380d7024191SGrygorii Strashko {
381bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_PEER_RT_EN_REG,
382*52c74d3dSGrygorii Strashko 			    UDMA_PEER_RT_EN_ENABLE);
383d7024191SGrygorii Strashko 
384bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG,
385*52c74d3dSGrygorii Strashko 			    UDMA_CHAN_RT_CTL_EN);
386d7024191SGrygorii Strashko 
387d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn en");
388d7024191SGrygorii Strashko 	return 0;
389d7024191SGrygorii Strashko }
390d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_enable_tx_chn);
391d7024191SGrygorii Strashko 
392d7024191SGrygorii Strashko void k3_udma_glue_disable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn)
393d7024191SGrygorii Strashko {
394d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis1");
395d7024191SGrygorii Strashko 
396bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 0);
397d7024191SGrygorii Strashko 
398d7024191SGrygorii Strashko 	xudma_tchanrt_write(tx_chn->udma_tchanx,
399bc7e5523SPeter Ujfalusi 			    UDMA_CHAN_RT_PEER_RT_EN_REG, 0);
400d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis2");
401d7024191SGrygorii Strashko }
402d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_disable_tx_chn);
403d7024191SGrygorii Strashko 
404d7024191SGrygorii Strashko void k3_udma_glue_tdown_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
405d7024191SGrygorii Strashko 			       bool sync)
406d7024191SGrygorii Strashko {
407d7024191SGrygorii Strashko 	int i = 0;
408d7024191SGrygorii Strashko 	u32 val;
409d7024191SGrygorii Strashko 
410d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown1");
411d7024191SGrygorii Strashko 
412bc7e5523SPeter Ujfalusi 	xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG,
413d7024191SGrygorii Strashko 			    UDMA_CHAN_RT_CTL_EN | UDMA_CHAN_RT_CTL_TDOWN);
414d7024191SGrygorii Strashko 
415bc7e5523SPeter Ujfalusi 	val = xudma_tchanrt_read(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG);
416d7024191SGrygorii Strashko 
417d7024191SGrygorii Strashko 	while (sync && (val & UDMA_CHAN_RT_CTL_EN)) {
418d7024191SGrygorii Strashko 		val = xudma_tchanrt_read(tx_chn->udma_tchanx,
419bc7e5523SPeter Ujfalusi 					 UDMA_CHAN_RT_CTL_REG);
420d7024191SGrygorii Strashko 		udelay(1);
421d7024191SGrygorii Strashko 		if (i > K3_UDMAX_TDOWN_TIMEOUT_US) {
422d7024191SGrygorii Strashko 			dev_err(tx_chn->common.dev, "TX tdown timeout\n");
423d7024191SGrygorii Strashko 			break;
424d7024191SGrygorii Strashko 		}
425d7024191SGrygorii Strashko 		i++;
426d7024191SGrygorii Strashko 	}
427d7024191SGrygorii Strashko 
428d7024191SGrygorii Strashko 	val = xudma_tchanrt_read(tx_chn->udma_tchanx,
429bc7e5523SPeter Ujfalusi 				 UDMA_CHAN_RT_PEER_RT_EN_REG);
430d7024191SGrygorii Strashko 	if (sync && (val & UDMA_PEER_RT_EN_ENABLE))
431d7024191SGrygorii Strashko 		dev_err(tx_chn->common.dev, "TX tdown peer not stopped\n");
432d7024191SGrygorii Strashko 	k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown2");
433d7024191SGrygorii Strashko }
434d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tdown_tx_chn);
435d7024191SGrygorii Strashko 
436d7024191SGrygorii Strashko void k3_udma_glue_reset_tx_chn(struct k3_udma_glue_tx_channel *tx_chn,
437d7024191SGrygorii Strashko 			       void *data,
438d7024191SGrygorii Strashko 			       void (*cleanup)(void *data, dma_addr_t desc_dma))
439d7024191SGrygorii Strashko {
440d7024191SGrygorii Strashko 	dma_addr_t desc_dma;
441d7024191SGrygorii Strashko 	int occ_tx, i, ret;
442d7024191SGrygorii Strashko 
443d7024191SGrygorii Strashko 	/* reset TXCQ as it is not input for udma - expected to be empty */
444d7024191SGrygorii Strashko 	if (tx_chn->ringtxcq)
445d7024191SGrygorii Strashko 		k3_ringacc_ring_reset(tx_chn->ringtxcq);
446d7024191SGrygorii Strashko 
447d7024191SGrygorii Strashko 	/*
448d7024191SGrygorii Strashko 	 * TXQ reset need to be special way as it is input for udma and its
449d7024191SGrygorii Strashko 	 * state cached by udma, so:
450d7024191SGrygorii Strashko 	 * 1) save TXQ occ
451d7024191SGrygorii Strashko 	 * 2) clean up TXQ and call callback .cleanup() for each desc
452d7024191SGrygorii Strashko 	 * 3) reset TXQ in a special way
453d7024191SGrygorii Strashko 	 */
454d7024191SGrygorii Strashko 	occ_tx = k3_ringacc_ring_get_occ(tx_chn->ringtx);
455d7024191SGrygorii Strashko 	dev_dbg(tx_chn->common.dev, "TX reset occ_tx %u\n", occ_tx);
456d7024191SGrygorii Strashko 
457d7024191SGrygorii Strashko 	for (i = 0; i < occ_tx; i++) {
458d7024191SGrygorii Strashko 		ret = k3_ringacc_ring_pop(tx_chn->ringtx, &desc_dma);
459d7024191SGrygorii Strashko 		if (ret) {
460d7024191SGrygorii Strashko 			dev_err(tx_chn->common.dev, "TX reset pop %d\n", ret);
461d7024191SGrygorii Strashko 			break;
462d7024191SGrygorii Strashko 		}
463d7024191SGrygorii Strashko 		cleanup(data, desc_dma);
464d7024191SGrygorii Strashko 	}
465d7024191SGrygorii Strashko 
466d7024191SGrygorii Strashko 	k3_ringacc_ring_reset_dma(tx_chn->ringtx, occ_tx);
467d7024191SGrygorii Strashko }
468d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_reset_tx_chn);
469d7024191SGrygorii Strashko 
470d7024191SGrygorii Strashko u32 k3_udma_glue_tx_get_hdesc_size(struct k3_udma_glue_tx_channel *tx_chn)
471d7024191SGrygorii Strashko {
472d7024191SGrygorii Strashko 	return tx_chn->common.hdesc_size;
473d7024191SGrygorii Strashko }
474d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_hdesc_size);
475d7024191SGrygorii Strashko 
476d7024191SGrygorii Strashko u32 k3_udma_glue_tx_get_txcq_id(struct k3_udma_glue_tx_channel *tx_chn)
477d7024191SGrygorii Strashko {
478d7024191SGrygorii Strashko 	return k3_ringacc_get_ring_id(tx_chn->ringtxcq);
479d7024191SGrygorii Strashko }
480d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_txcq_id);
481d7024191SGrygorii Strashko 
482d7024191SGrygorii Strashko int k3_udma_glue_tx_get_irq(struct k3_udma_glue_tx_channel *tx_chn)
483d7024191SGrygorii Strashko {
484d7024191SGrygorii Strashko 	tx_chn->virq = k3_ringacc_get_ring_irq_num(tx_chn->ringtxcq);
485d7024191SGrygorii Strashko 
486d7024191SGrygorii Strashko 	return tx_chn->virq;
487d7024191SGrygorii Strashko }
488d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_irq);
489d7024191SGrygorii Strashko 
490d7024191SGrygorii Strashko static int k3_udma_glue_cfg_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
491d7024191SGrygorii Strashko {
492d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
493d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_rx_ch_cfg req;
494d7024191SGrygorii Strashko 	int ret;
495d7024191SGrygorii Strashko 
496d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
497d7024191SGrygorii Strashko 
498d7024191SGrygorii Strashko 	req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID |
499d7024191SGrygorii Strashko 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID |
500d7024191SGrygorii Strashko 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID |
501d7024191SGrygorii Strashko 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_START_VALID |
5020ebcf1a2SPeter Ujfalusi 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_CNT_VALID |
5030ebcf1a2SPeter Ujfalusi 			   TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID;
504d7024191SGrygorii Strashko 
505d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
506d7024191SGrygorii Strashko 	req.index = rx_chn->udma_rchan_id;
507d7024191SGrygorii Strashko 	req.rx_fetch_size = rx_chn->common.hdesc_size >> 2;
508d7024191SGrygorii Strashko 	/*
509d7024191SGrygorii Strashko 	 * TODO: we can't support rxcq_qnum/RCHAN[a]_RCQ cfg with current sysfw
510d7024191SGrygorii Strashko 	 * and udmax impl, so just configure it to invalid value.
511d7024191SGrygorii Strashko 	 * req.rxcq_qnum = k3_ringacc_get_ring_id(rx_chn->flows[0].ringrx);
512d7024191SGrygorii Strashko 	 */
513d7024191SGrygorii Strashko 	req.rxcq_qnum = 0xFFFF;
514d7024191SGrygorii Strashko 	if (rx_chn->flow_num && rx_chn->flow_id_base != rx_chn->udma_rchan_id) {
515d7024191SGrygorii Strashko 		/* Default flow + extra ones */
516d7024191SGrygorii Strashko 		req.flowid_start = rx_chn->flow_id_base;
517d7024191SGrygorii Strashko 		req.flowid_cnt = rx_chn->flow_num;
518d7024191SGrygorii Strashko 	}
519d7024191SGrygorii Strashko 	req.rx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR;
5200ebcf1a2SPeter Ujfalusi 	req.rx_atype = rx_chn->common.atype;
521d7024191SGrygorii Strashko 
522d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_ch_cfg(tisci_rm->tisci, &req);
523d7024191SGrygorii Strashko 	if (ret)
524d7024191SGrygorii Strashko 		dev_err(rx_chn->common.dev, "rchan%d cfg failed %d\n",
525d7024191SGrygorii Strashko 			rx_chn->udma_rchan_id, ret);
526d7024191SGrygorii Strashko 
527d7024191SGrygorii Strashko 	return ret;
528d7024191SGrygorii Strashko }
529d7024191SGrygorii Strashko 
530d7024191SGrygorii Strashko static void k3_udma_glue_release_rx_flow(struct k3_udma_glue_rx_channel *rx_chn,
531d7024191SGrygorii Strashko 					 u32 flow_num)
532d7024191SGrygorii Strashko {
533d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
534d7024191SGrygorii Strashko 
535d7024191SGrygorii Strashko 	if (IS_ERR_OR_NULL(flow->udma_rflow))
536d7024191SGrygorii Strashko 		return;
537d7024191SGrygorii Strashko 
538d7024191SGrygorii Strashko 	if (flow->ringrxfdq)
539d7024191SGrygorii Strashko 		k3_ringacc_ring_free(flow->ringrxfdq);
540d7024191SGrygorii Strashko 
541d7024191SGrygorii Strashko 	if (flow->ringrx)
542d7024191SGrygorii Strashko 		k3_ringacc_ring_free(flow->ringrx);
543d7024191SGrygorii Strashko 
544d7024191SGrygorii Strashko 	xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow);
545d7024191SGrygorii Strashko 	flow->udma_rflow = NULL;
546d7024191SGrygorii Strashko 	rx_chn->flows_ready--;
547d7024191SGrygorii Strashko }
548d7024191SGrygorii Strashko 
549d7024191SGrygorii Strashko static int k3_udma_glue_cfg_rx_flow(struct k3_udma_glue_rx_channel *rx_chn,
550d7024191SGrygorii Strashko 				    u32 flow_idx,
551d7024191SGrygorii Strashko 				    struct k3_udma_glue_rx_flow_cfg *flow_cfg)
552d7024191SGrygorii Strashko {
553d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx];
554d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
555d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
556d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_flow_cfg req;
557d7024191SGrygorii Strashko 	int rx_ring_id;
558d7024191SGrygorii Strashko 	int rx_ringfdq_id;
559d7024191SGrygorii Strashko 	int ret = 0;
560d7024191SGrygorii Strashko 
561d7024191SGrygorii Strashko 	flow->udma_rflow = xudma_rflow_get(rx_chn->common.udmax,
562d7024191SGrygorii Strashko 					   flow->udma_rflow_id);
563d7024191SGrygorii Strashko 	if (IS_ERR(flow->udma_rflow)) {
564d7024191SGrygorii Strashko 		ret = PTR_ERR(flow->udma_rflow);
565d7024191SGrygorii Strashko 		dev_err(dev, "UDMAX rflow get err %d\n", ret);
566018af9beSChristophe JAILLET 		return ret;
567d7024191SGrygorii Strashko 	}
568d7024191SGrygorii Strashko 
569d7024191SGrygorii Strashko 	if (flow->udma_rflow_id != xudma_rflow_get_id(flow->udma_rflow)) {
570018af9beSChristophe JAILLET 		ret = -ENODEV;
571018af9beSChristophe JAILLET 		goto err_rflow_put;
572d7024191SGrygorii Strashko 	}
573d7024191SGrygorii Strashko 
574d7024191SGrygorii Strashko 	/* request and cfg rings */
5754927b1abSPeter Ujfalusi 	ret =  k3_ringacc_request_rings_pair(rx_chn->common.ringacc,
5764927b1abSPeter Ujfalusi 					     flow_cfg->ring_rxq_id,
5774927b1abSPeter Ujfalusi 					     flow_cfg->ring_rxfdq0_id,
5784927b1abSPeter Ujfalusi 					     &flow->ringrxfdq,
5794927b1abSPeter Ujfalusi 					     &flow->ringrx);
5804927b1abSPeter Ujfalusi 	if (ret) {
5814927b1abSPeter Ujfalusi 		dev_err(dev, "Failed to get RX/RXFDQ rings %d\n", ret);
582018af9beSChristophe JAILLET 		goto err_rflow_put;
583d7024191SGrygorii Strashko 	}
584d7024191SGrygorii Strashko 
585d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(flow->ringrx, &flow_cfg->rx_cfg);
586d7024191SGrygorii Strashko 	if (ret) {
587d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringrx %d\n", ret);
588018af9beSChristophe JAILLET 		goto err_ringrxfdq_free;
589d7024191SGrygorii Strashko 	}
590d7024191SGrygorii Strashko 
591d7024191SGrygorii Strashko 	ret = k3_ringacc_ring_cfg(flow->ringrxfdq, &flow_cfg->rxfdq_cfg);
592d7024191SGrygorii Strashko 	if (ret) {
593d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg ringrxfdq %d\n", ret);
594018af9beSChristophe JAILLET 		goto err_ringrxfdq_free;
595d7024191SGrygorii Strashko 	}
596d7024191SGrygorii Strashko 
597d7024191SGrygorii Strashko 	if (rx_chn->remote) {
598d7024191SGrygorii Strashko 		rx_ring_id = TI_SCI_RESOURCE_NULL;
599d7024191SGrygorii Strashko 		rx_ringfdq_id = TI_SCI_RESOURCE_NULL;
600d7024191SGrygorii Strashko 	} else {
601d7024191SGrygorii Strashko 		rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx);
602d7024191SGrygorii Strashko 		rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq);
603d7024191SGrygorii Strashko 	}
604d7024191SGrygorii Strashko 
605d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
606d7024191SGrygorii Strashko 
607d7024191SGrygorii Strashko 	req.valid_params =
608d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_EINFO_PRESENT_VALID |
609d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_PSINFO_PRESENT_VALID |
610d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_ERROR_HANDLING_VALID |
611d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DESC_TYPE_VALID |
612d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID |
613d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_HI_SEL_VALID |
614d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_LO_SEL_VALID |
615d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_HI_SEL_VALID |
616d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_LO_SEL_VALID |
617d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID |
618d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID |
619d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID |
620d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID;
621d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
622d7024191SGrygorii Strashko 	req.flow_index = flow->udma_rflow_id;
623d7024191SGrygorii Strashko 	if (rx_chn->common.epib)
624d7024191SGrygorii Strashko 		req.rx_einfo_present = 1;
625d7024191SGrygorii Strashko 	if (rx_chn->common.psdata_size)
626d7024191SGrygorii Strashko 		req.rx_psinfo_present = 1;
627d7024191SGrygorii Strashko 	if (flow_cfg->rx_error_handling)
628d7024191SGrygorii Strashko 		req.rx_error_handling = 1;
629d7024191SGrygorii Strashko 	req.rx_desc_type = 0;
630d7024191SGrygorii Strashko 	req.rx_dest_qnum = rx_ring_id;
631d7024191SGrygorii Strashko 	req.rx_src_tag_hi_sel = 0;
632d7024191SGrygorii Strashko 	req.rx_src_tag_lo_sel = flow_cfg->src_tag_lo_sel;
633d7024191SGrygorii Strashko 	req.rx_dest_tag_hi_sel = 0;
634d7024191SGrygorii Strashko 	req.rx_dest_tag_lo_sel = 0;
635d7024191SGrygorii Strashko 	req.rx_fdq0_sz0_qnum = rx_ringfdq_id;
636d7024191SGrygorii Strashko 	req.rx_fdq1_qnum = rx_ringfdq_id;
637d7024191SGrygorii Strashko 	req.rx_fdq2_qnum = rx_ringfdq_id;
638d7024191SGrygorii Strashko 	req.rx_fdq3_qnum = rx_ringfdq_id;
639d7024191SGrygorii Strashko 
640d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req);
641d7024191SGrygorii Strashko 	if (ret) {
642d7024191SGrygorii Strashko 		dev_err(dev, "flow%d config failed: %d\n", flow->udma_rflow_id,
643d7024191SGrygorii Strashko 			ret);
644018af9beSChristophe JAILLET 		goto err_ringrxfdq_free;
645d7024191SGrygorii Strashko 	}
646d7024191SGrygorii Strashko 
647d7024191SGrygorii Strashko 	rx_chn->flows_ready++;
648d7024191SGrygorii Strashko 	dev_dbg(dev, "flow%d config done. ready:%d\n",
649d7024191SGrygorii Strashko 		flow->udma_rflow_id, rx_chn->flows_ready);
650d7024191SGrygorii Strashko 
651d7024191SGrygorii Strashko 	return 0;
652018af9beSChristophe JAILLET 
653018af9beSChristophe JAILLET err_ringrxfdq_free:
654018af9beSChristophe JAILLET 	k3_ringacc_ring_free(flow->ringrxfdq);
655018af9beSChristophe JAILLET 	k3_ringacc_ring_free(flow->ringrx);
656018af9beSChristophe JAILLET 
657018af9beSChristophe JAILLET err_rflow_put:
658018af9beSChristophe JAILLET 	xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow);
659018af9beSChristophe JAILLET 	flow->udma_rflow = NULL;
660018af9beSChristophe JAILLET 
661d7024191SGrygorii Strashko 	return ret;
662d7024191SGrygorii Strashko }
663d7024191SGrygorii Strashko 
664d7024191SGrygorii Strashko static void k3_udma_glue_dump_rx_chn(struct k3_udma_glue_rx_channel *chn)
665d7024191SGrygorii Strashko {
666d7024191SGrygorii Strashko 	struct device *dev = chn->common.dev;
667d7024191SGrygorii Strashko 
668d7024191SGrygorii Strashko 	dev_dbg(dev, "dump_rx_chn:\n"
669d7024191SGrygorii Strashko 		"udma_rchan_id: %d\n"
670d7024191SGrygorii Strashko 		"src_thread: %08x\n"
671d7024191SGrygorii Strashko 		"dst_thread: %08x\n"
672d7024191SGrygorii Strashko 		"epib: %d\n"
673d7024191SGrygorii Strashko 		"hdesc_size: %u\n"
674d7024191SGrygorii Strashko 		"psdata_size: %u\n"
675d7024191SGrygorii Strashko 		"swdata_size: %u\n"
676d7024191SGrygorii Strashko 		"flow_id_base: %d\n"
677d7024191SGrygorii Strashko 		"flow_num: %d\n",
678d7024191SGrygorii Strashko 		chn->udma_rchan_id,
679d7024191SGrygorii Strashko 		chn->common.src_thread,
680d7024191SGrygorii Strashko 		chn->common.dst_thread,
681d7024191SGrygorii Strashko 		chn->common.epib,
682d7024191SGrygorii Strashko 		chn->common.hdesc_size,
683d7024191SGrygorii Strashko 		chn->common.psdata_size,
684d7024191SGrygorii Strashko 		chn->common.swdata_size,
685d7024191SGrygorii Strashko 		chn->flow_id_base,
686d7024191SGrygorii Strashko 		chn->flow_num);
687d7024191SGrygorii Strashko }
688d7024191SGrygorii Strashko 
689d7024191SGrygorii Strashko static void k3_udma_glue_dump_rx_rt_chn(struct k3_udma_glue_rx_channel *chn,
690d7024191SGrygorii Strashko 					char *mark)
691d7024191SGrygorii Strashko {
692d7024191SGrygorii Strashko 	struct device *dev = chn->common.dev;
693d7024191SGrygorii Strashko 
694d7024191SGrygorii Strashko 	dev_dbg(dev, "=== dump ===> %s\n", mark);
695d7024191SGrygorii Strashko 
696bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG,
697bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG));
698bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG,
699d7024191SGrygorii Strashko 		xudma_rchanrt_read(chn->udma_rchanx,
700bc7e5523SPeter Ujfalusi 				   UDMA_CHAN_RT_PEER_RT_EN_REG));
701bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG,
702bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_PCNT_REG));
703bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG,
704bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_BCNT_REG));
705bc7e5523SPeter Ujfalusi 	dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG,
706bc7e5523SPeter Ujfalusi 		xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_SBCNT_REG));
707d7024191SGrygorii Strashko }
708d7024191SGrygorii Strashko 
709d7024191SGrygorii Strashko static int
710d7024191SGrygorii Strashko k3_udma_glue_allocate_rx_flows(struct k3_udma_glue_rx_channel *rx_chn,
711d7024191SGrygorii Strashko 			       struct k3_udma_glue_rx_channel_cfg *cfg)
712d7024191SGrygorii Strashko {
713d7024191SGrygorii Strashko 	int ret;
714d7024191SGrygorii Strashko 
715d7024191SGrygorii Strashko 	/* default rflow */
716d7024191SGrygorii Strashko 	if (cfg->flow_id_use_rxchan_id)
717d7024191SGrygorii Strashko 		return 0;
718d7024191SGrygorii Strashko 
719d7024191SGrygorii Strashko 	/* not a GP rflows */
720d7024191SGrygorii Strashko 	if (rx_chn->flow_id_base != -1 &&
721d7024191SGrygorii Strashko 	    !xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base))
722d7024191SGrygorii Strashko 		return 0;
723d7024191SGrygorii Strashko 
724d7024191SGrygorii Strashko 	/* Allocate range of GP rflows */
725d7024191SGrygorii Strashko 	ret = xudma_alloc_gp_rflow_range(rx_chn->common.udmax,
726d7024191SGrygorii Strashko 					 rx_chn->flow_id_base,
727d7024191SGrygorii Strashko 					 rx_chn->flow_num);
728d7024191SGrygorii Strashko 	if (ret < 0) {
729d7024191SGrygorii Strashko 		dev_err(rx_chn->common.dev, "UDMAX reserve_rflow %d cnt:%d err: %d\n",
730d7024191SGrygorii Strashko 			rx_chn->flow_id_base, rx_chn->flow_num, ret);
731d7024191SGrygorii Strashko 		return ret;
732d7024191SGrygorii Strashko 	}
733d7024191SGrygorii Strashko 	rx_chn->flow_id_base = ret;
734d7024191SGrygorii Strashko 
735d7024191SGrygorii Strashko 	return 0;
736d7024191SGrygorii Strashko }
737d7024191SGrygorii Strashko 
738d7024191SGrygorii Strashko static struct k3_udma_glue_rx_channel *
739d7024191SGrygorii Strashko k3_udma_glue_request_rx_chn_priv(struct device *dev, const char *name,
740d7024191SGrygorii Strashko 				 struct k3_udma_glue_rx_channel_cfg *cfg)
741d7024191SGrygorii Strashko {
742d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_channel *rx_chn;
743d7024191SGrygorii Strashko 	int ret, i;
744d7024191SGrygorii Strashko 
745d7024191SGrygorii Strashko 	if (cfg->flow_id_num <= 0)
746d7024191SGrygorii Strashko 		return ERR_PTR(-EINVAL);
747d7024191SGrygorii Strashko 
748d7024191SGrygorii Strashko 	if (cfg->flow_id_num != 1 &&
749d7024191SGrygorii Strashko 	    (cfg->def_flow_cfg || cfg->flow_id_use_rxchan_id))
750d7024191SGrygorii Strashko 		return ERR_PTR(-EINVAL);
751d7024191SGrygorii Strashko 
752d7024191SGrygorii Strashko 	rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL);
753d7024191SGrygorii Strashko 	if (!rx_chn)
754d7024191SGrygorii Strashko 		return ERR_PTR(-ENOMEM);
755d7024191SGrygorii Strashko 
756d7024191SGrygorii Strashko 	rx_chn->common.dev = dev;
757d7024191SGrygorii Strashko 	rx_chn->common.swdata_size = cfg->swdata_size;
758d7024191SGrygorii Strashko 	rx_chn->remote = false;
759d7024191SGrygorii Strashko 
760d7024191SGrygorii Strashko 	/* parse of udmap channel */
761d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse_chn(dev->of_node, name,
762d7024191SGrygorii Strashko 					&rx_chn->common, false);
763d7024191SGrygorii Strashko 	if (ret)
764d7024191SGrygorii Strashko 		goto err;
765d7024191SGrygorii Strashko 
766d7024191SGrygorii Strashko 	rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib,
767d7024191SGrygorii Strashko 						rx_chn->common.psdata_size,
768d7024191SGrygorii Strashko 						rx_chn->common.swdata_size);
769d7024191SGrygorii Strashko 
770d7024191SGrygorii Strashko 	/* request and cfg UDMAP RX channel */
771d7024191SGrygorii Strashko 	rx_chn->udma_rchanx = xudma_rchan_get(rx_chn->common.udmax, -1);
772d7024191SGrygorii Strashko 	if (IS_ERR(rx_chn->udma_rchanx)) {
773d7024191SGrygorii Strashko 		ret = PTR_ERR(rx_chn->udma_rchanx);
774d7024191SGrygorii Strashko 		dev_err(dev, "UDMAX rchanx get err %d\n", ret);
775d7024191SGrygorii Strashko 		goto err;
776d7024191SGrygorii Strashko 	}
777d7024191SGrygorii Strashko 	rx_chn->udma_rchan_id = xudma_rchan_get_id(rx_chn->udma_rchanx);
778d7024191SGrygorii Strashko 
779d7024191SGrygorii Strashko 	rx_chn->flow_num = cfg->flow_id_num;
780d7024191SGrygorii Strashko 	rx_chn->flow_id_base = cfg->flow_id_base;
781d7024191SGrygorii Strashko 
782d7024191SGrygorii Strashko 	/* Use RX channel id as flow id: target dev can't generate flow_id */
783d7024191SGrygorii Strashko 	if (cfg->flow_id_use_rxchan_id)
784d7024191SGrygorii Strashko 		rx_chn->flow_id_base = rx_chn->udma_rchan_id;
785d7024191SGrygorii Strashko 
786d7024191SGrygorii Strashko 	rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num,
787d7024191SGrygorii Strashko 				     sizeof(*rx_chn->flows), GFP_KERNEL);
788d7024191SGrygorii Strashko 	if (!rx_chn->flows) {
789d7024191SGrygorii Strashko 		ret = -ENOMEM;
790d7024191SGrygorii Strashko 		goto err;
791d7024191SGrygorii Strashko 	}
792d7024191SGrygorii Strashko 
793d7024191SGrygorii Strashko 	ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg);
794d7024191SGrygorii Strashko 	if (ret)
795d7024191SGrygorii Strashko 		goto err;
796d7024191SGrygorii Strashko 
797d7024191SGrygorii Strashko 	for (i = 0; i < rx_chn->flow_num; i++)
798d7024191SGrygorii Strashko 		rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i;
799d7024191SGrygorii Strashko 
800d7024191SGrygorii Strashko 	/* request and cfg psi-l */
801d7024191SGrygorii Strashko 	rx_chn->common.dst_thread =
802d7024191SGrygorii Strashko 			xudma_dev_get_psil_base(rx_chn->common.udmax) +
803d7024191SGrygorii Strashko 			rx_chn->udma_rchan_id;
804d7024191SGrygorii Strashko 
805d7024191SGrygorii Strashko 	ret = k3_udma_glue_cfg_rx_chn(rx_chn);
806d7024191SGrygorii Strashko 	if (ret) {
807d7024191SGrygorii Strashko 		dev_err(dev, "Failed to cfg rchan %d\n", ret);
808d7024191SGrygorii Strashko 		goto err;
809d7024191SGrygorii Strashko 	}
810d7024191SGrygorii Strashko 
811d7024191SGrygorii Strashko 	/* init default RX flow only if flow_num = 1 */
812d7024191SGrygorii Strashko 	if (cfg->def_flow_cfg) {
813d7024191SGrygorii Strashko 		ret = k3_udma_glue_cfg_rx_flow(rx_chn, 0, cfg->def_flow_cfg);
814d7024191SGrygorii Strashko 		if (ret)
815d7024191SGrygorii Strashko 			goto err;
816d7024191SGrygorii Strashko 	}
817d7024191SGrygorii Strashko 
818d7024191SGrygorii Strashko 	ret = xudma_navss_psil_pair(rx_chn->common.udmax,
819d7024191SGrygorii Strashko 				    rx_chn->common.src_thread,
820d7024191SGrygorii Strashko 				    rx_chn->common.dst_thread);
821d7024191SGrygorii Strashko 	if (ret) {
822d7024191SGrygorii Strashko 		dev_err(dev, "PSI-L request err %d\n", ret);
823d7024191SGrygorii Strashko 		goto err;
824d7024191SGrygorii Strashko 	}
825d7024191SGrygorii Strashko 
826d7024191SGrygorii Strashko 	rx_chn->psil_paired = true;
827d7024191SGrygorii Strashko 
828d7024191SGrygorii Strashko 	/* reset RX RT registers */
829d7024191SGrygorii Strashko 	k3_udma_glue_disable_rx_chn(rx_chn);
830d7024191SGrygorii Strashko 
831d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_chn(rx_chn);
832d7024191SGrygorii Strashko 
833d7024191SGrygorii Strashko 	return rx_chn;
834d7024191SGrygorii Strashko 
835d7024191SGrygorii Strashko err:
836d7024191SGrygorii Strashko 	k3_udma_glue_release_rx_chn(rx_chn);
837d7024191SGrygorii Strashko 	return ERR_PTR(ret);
838d7024191SGrygorii Strashko }
839d7024191SGrygorii Strashko 
840d7024191SGrygorii Strashko static struct k3_udma_glue_rx_channel *
841d7024191SGrygorii Strashko k3_udma_glue_request_remote_rx_chn(struct device *dev, const char *name,
842d7024191SGrygorii Strashko 				   struct k3_udma_glue_rx_channel_cfg *cfg)
843d7024191SGrygorii Strashko {
844d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_channel *rx_chn;
845d7024191SGrygorii Strashko 	int ret, i;
846d7024191SGrygorii Strashko 
847d7024191SGrygorii Strashko 	if (cfg->flow_id_num <= 0 ||
848d7024191SGrygorii Strashko 	    cfg->flow_id_use_rxchan_id ||
849d7024191SGrygorii Strashko 	    cfg->def_flow_cfg ||
850d7024191SGrygorii Strashko 	    cfg->flow_id_base < 0)
851d7024191SGrygorii Strashko 		return ERR_PTR(-EINVAL);
852d7024191SGrygorii Strashko 
853d7024191SGrygorii Strashko 	/*
854d7024191SGrygorii Strashko 	 * Remote RX channel is under control of Remote CPU core, so
855d7024191SGrygorii Strashko 	 * Linux can only request and manipulate by dedicated RX flows
856d7024191SGrygorii Strashko 	 */
857d7024191SGrygorii Strashko 
858d7024191SGrygorii Strashko 	rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL);
859d7024191SGrygorii Strashko 	if (!rx_chn)
860d7024191SGrygorii Strashko 		return ERR_PTR(-ENOMEM);
861d7024191SGrygorii Strashko 
862d7024191SGrygorii Strashko 	rx_chn->common.dev = dev;
863d7024191SGrygorii Strashko 	rx_chn->common.swdata_size = cfg->swdata_size;
864d7024191SGrygorii Strashko 	rx_chn->remote = true;
865d7024191SGrygorii Strashko 	rx_chn->udma_rchan_id = -1;
866d7024191SGrygorii Strashko 	rx_chn->flow_num = cfg->flow_id_num;
867d7024191SGrygorii Strashko 	rx_chn->flow_id_base = cfg->flow_id_base;
868d7024191SGrygorii Strashko 	rx_chn->psil_paired = false;
869d7024191SGrygorii Strashko 
870d7024191SGrygorii Strashko 	/* parse of udmap channel */
871d7024191SGrygorii Strashko 	ret = of_k3_udma_glue_parse_chn(dev->of_node, name,
872d7024191SGrygorii Strashko 					&rx_chn->common, false);
873d7024191SGrygorii Strashko 	if (ret)
874d7024191SGrygorii Strashko 		goto err;
875d7024191SGrygorii Strashko 
876d7024191SGrygorii Strashko 	rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib,
877d7024191SGrygorii Strashko 						rx_chn->common.psdata_size,
878d7024191SGrygorii Strashko 						rx_chn->common.swdata_size);
879d7024191SGrygorii Strashko 
880d7024191SGrygorii Strashko 	rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num,
881d7024191SGrygorii Strashko 				     sizeof(*rx_chn->flows), GFP_KERNEL);
882d7024191SGrygorii Strashko 	if (!rx_chn->flows) {
883d7024191SGrygorii Strashko 		ret = -ENOMEM;
884d7024191SGrygorii Strashko 		goto err;
885d7024191SGrygorii Strashko 	}
886d7024191SGrygorii Strashko 
887d7024191SGrygorii Strashko 	ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg);
888d7024191SGrygorii Strashko 	if (ret)
889d7024191SGrygorii Strashko 		goto err;
890d7024191SGrygorii Strashko 
891d7024191SGrygorii Strashko 	for (i = 0; i < rx_chn->flow_num; i++)
892d7024191SGrygorii Strashko 		rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i;
893d7024191SGrygorii Strashko 
894d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_chn(rx_chn);
895d7024191SGrygorii Strashko 
896d7024191SGrygorii Strashko 	return rx_chn;
897d7024191SGrygorii Strashko 
898d7024191SGrygorii Strashko err:
899d7024191SGrygorii Strashko 	k3_udma_glue_release_rx_chn(rx_chn);
900d7024191SGrygorii Strashko 	return ERR_PTR(ret);
901d7024191SGrygorii Strashko }
902d7024191SGrygorii Strashko 
903d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel *
904d7024191SGrygorii Strashko k3_udma_glue_request_rx_chn(struct device *dev, const char *name,
905d7024191SGrygorii Strashko 			    struct k3_udma_glue_rx_channel_cfg *cfg)
906d7024191SGrygorii Strashko {
907d7024191SGrygorii Strashko 	if (cfg->remote)
908d7024191SGrygorii Strashko 		return k3_udma_glue_request_remote_rx_chn(dev, name, cfg);
909d7024191SGrygorii Strashko 	else
910d7024191SGrygorii Strashko 		return k3_udma_glue_request_rx_chn_priv(dev, name, cfg);
911d7024191SGrygorii Strashko }
912d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_request_rx_chn);
913d7024191SGrygorii Strashko 
914d7024191SGrygorii Strashko void k3_udma_glue_release_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
915d7024191SGrygorii Strashko {
916d7024191SGrygorii Strashko 	int i;
917d7024191SGrygorii Strashko 
918d7024191SGrygorii Strashko 	if (IS_ERR_OR_NULL(rx_chn->common.udmax))
919d7024191SGrygorii Strashko 		return;
920d7024191SGrygorii Strashko 
921d7024191SGrygorii Strashko 	if (rx_chn->psil_paired) {
922d7024191SGrygorii Strashko 		xudma_navss_psil_unpair(rx_chn->common.udmax,
923d7024191SGrygorii Strashko 					rx_chn->common.src_thread,
924d7024191SGrygorii Strashko 					rx_chn->common.dst_thread);
925d7024191SGrygorii Strashko 		rx_chn->psil_paired = false;
926d7024191SGrygorii Strashko 	}
927d7024191SGrygorii Strashko 
928d7024191SGrygorii Strashko 	for (i = 0; i < rx_chn->flow_num; i++)
929d7024191SGrygorii Strashko 		k3_udma_glue_release_rx_flow(rx_chn, i);
930d7024191SGrygorii Strashko 
931d7024191SGrygorii Strashko 	if (xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base))
932d7024191SGrygorii Strashko 		xudma_free_gp_rflow_range(rx_chn->common.udmax,
933d7024191SGrygorii Strashko 					  rx_chn->flow_id_base,
934d7024191SGrygorii Strashko 					  rx_chn->flow_num);
935d7024191SGrygorii Strashko 
936d7024191SGrygorii Strashko 	if (!IS_ERR_OR_NULL(rx_chn->udma_rchanx))
937d7024191SGrygorii Strashko 		xudma_rchan_put(rx_chn->common.udmax,
938d7024191SGrygorii Strashko 				rx_chn->udma_rchanx);
939d7024191SGrygorii Strashko }
940d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_release_rx_chn);
941d7024191SGrygorii Strashko 
942d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_init(struct k3_udma_glue_rx_channel *rx_chn,
943d7024191SGrygorii Strashko 			      u32 flow_idx,
944d7024191SGrygorii Strashko 			      struct k3_udma_glue_rx_flow_cfg *flow_cfg)
945d7024191SGrygorii Strashko {
946d7024191SGrygorii Strashko 	if (flow_idx >= rx_chn->flow_num)
947d7024191SGrygorii Strashko 		return -EINVAL;
948d7024191SGrygorii Strashko 
949d7024191SGrygorii Strashko 	return k3_udma_glue_cfg_rx_flow(rx_chn, flow_idx, flow_cfg);
950d7024191SGrygorii Strashko }
951d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_init);
952d7024191SGrygorii Strashko 
953d7024191SGrygorii Strashko u32 k3_udma_glue_rx_flow_get_fdq_id(struct k3_udma_glue_rx_channel *rx_chn,
954d7024191SGrygorii Strashko 				    u32 flow_idx)
955d7024191SGrygorii Strashko {
956d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow;
957d7024191SGrygorii Strashko 
958d7024191SGrygorii Strashko 	if (flow_idx >= rx_chn->flow_num)
959d7024191SGrygorii Strashko 		return -EINVAL;
960d7024191SGrygorii Strashko 
961d7024191SGrygorii Strashko 	flow = &rx_chn->flows[flow_idx];
962d7024191SGrygorii Strashko 
963d7024191SGrygorii Strashko 	return k3_ringacc_get_ring_id(flow->ringrxfdq);
964d7024191SGrygorii Strashko }
965d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_get_fdq_id);
966d7024191SGrygorii Strashko 
967d7024191SGrygorii Strashko u32 k3_udma_glue_rx_get_flow_id_base(struct k3_udma_glue_rx_channel *rx_chn)
968d7024191SGrygorii Strashko {
969d7024191SGrygorii Strashko 	return rx_chn->flow_id_base;
970d7024191SGrygorii Strashko }
971d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_flow_id_base);
972d7024191SGrygorii Strashko 
973d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_enable(struct k3_udma_glue_rx_channel *rx_chn,
974d7024191SGrygorii Strashko 				u32 flow_idx)
975d7024191SGrygorii Strashko {
976d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx];
977d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
978d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
979d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_flow_cfg req;
980d7024191SGrygorii Strashko 	int rx_ring_id;
981d7024191SGrygorii Strashko 	int rx_ringfdq_id;
982d7024191SGrygorii Strashko 	int ret = 0;
983d7024191SGrygorii Strashko 
984d7024191SGrygorii Strashko 	if (!rx_chn->remote)
985d7024191SGrygorii Strashko 		return -EINVAL;
986d7024191SGrygorii Strashko 
987d7024191SGrygorii Strashko 	rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx);
988d7024191SGrygorii Strashko 	rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq);
989d7024191SGrygorii Strashko 
990d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
991d7024191SGrygorii Strashko 
992d7024191SGrygorii Strashko 	req.valid_params =
993d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID |
994d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID |
995d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID |
996d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID |
997d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID;
998d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
999d7024191SGrygorii Strashko 	req.flow_index = flow->udma_rflow_id;
1000d7024191SGrygorii Strashko 	req.rx_dest_qnum = rx_ring_id;
1001d7024191SGrygorii Strashko 	req.rx_fdq0_sz0_qnum = rx_ringfdq_id;
1002d7024191SGrygorii Strashko 	req.rx_fdq1_qnum = rx_ringfdq_id;
1003d7024191SGrygorii Strashko 	req.rx_fdq2_qnum = rx_ringfdq_id;
1004d7024191SGrygorii Strashko 	req.rx_fdq3_qnum = rx_ringfdq_id;
1005d7024191SGrygorii Strashko 
1006d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req);
1007d7024191SGrygorii Strashko 	if (ret) {
1008d7024191SGrygorii Strashko 		dev_err(dev, "flow%d enable failed: %d\n", flow->udma_rflow_id,
1009d7024191SGrygorii Strashko 			ret);
1010d7024191SGrygorii Strashko 	}
1011d7024191SGrygorii Strashko 
1012d7024191SGrygorii Strashko 	return ret;
1013d7024191SGrygorii Strashko }
1014d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_enable);
1015d7024191SGrygorii Strashko 
1016d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_disable(struct k3_udma_glue_rx_channel *rx_chn,
1017d7024191SGrygorii Strashko 				 u32 flow_idx)
1018d7024191SGrygorii Strashko {
1019d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx];
1020d7024191SGrygorii Strashko 	const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm;
1021d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
1022d7024191SGrygorii Strashko 	struct ti_sci_msg_rm_udmap_flow_cfg req;
1023d7024191SGrygorii Strashko 	int ret = 0;
1024d7024191SGrygorii Strashko 
1025d7024191SGrygorii Strashko 	if (!rx_chn->remote)
1026d7024191SGrygorii Strashko 		return -EINVAL;
1027d7024191SGrygorii Strashko 
1028d7024191SGrygorii Strashko 	memset(&req, 0, sizeof(req));
1029d7024191SGrygorii Strashko 	req.valid_params =
1030d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID |
1031d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID |
1032d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID |
1033d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID |
1034d7024191SGrygorii Strashko 			TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID;
1035d7024191SGrygorii Strashko 	req.nav_id = tisci_rm->tisci_dev_id;
1036d7024191SGrygorii Strashko 	req.flow_index = flow->udma_rflow_id;
1037d7024191SGrygorii Strashko 	req.rx_dest_qnum = TI_SCI_RESOURCE_NULL;
1038d7024191SGrygorii Strashko 	req.rx_fdq0_sz0_qnum = TI_SCI_RESOURCE_NULL;
1039d7024191SGrygorii Strashko 	req.rx_fdq1_qnum = TI_SCI_RESOURCE_NULL;
1040d7024191SGrygorii Strashko 	req.rx_fdq2_qnum = TI_SCI_RESOURCE_NULL;
1041d7024191SGrygorii Strashko 	req.rx_fdq3_qnum = TI_SCI_RESOURCE_NULL;
1042d7024191SGrygorii Strashko 
1043d7024191SGrygorii Strashko 	ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req);
1044d7024191SGrygorii Strashko 	if (ret) {
1045d7024191SGrygorii Strashko 		dev_err(dev, "flow%d disable failed: %d\n", flow->udma_rflow_id,
1046d7024191SGrygorii Strashko 			ret);
1047d7024191SGrygorii Strashko 	}
1048d7024191SGrygorii Strashko 
1049d7024191SGrygorii Strashko 	return ret;
1050d7024191SGrygorii Strashko }
1051d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_disable);
1052d7024191SGrygorii Strashko 
1053d7024191SGrygorii Strashko int k3_udma_glue_enable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
1054d7024191SGrygorii Strashko {
1055d7024191SGrygorii Strashko 	if (rx_chn->remote)
1056d7024191SGrygorii Strashko 		return -EINVAL;
1057d7024191SGrygorii Strashko 
1058d7024191SGrygorii Strashko 	if (rx_chn->flows_ready < rx_chn->flow_num)
1059d7024191SGrygorii Strashko 		return -EINVAL;
1060d7024191SGrygorii Strashko 
1061bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG,
1062*52c74d3dSGrygorii Strashko 			    UDMA_CHAN_RT_CTL_EN);
1063d7024191SGrygorii Strashko 
1064bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG,
1065d7024191SGrygorii Strashko 			    UDMA_PEER_RT_EN_ENABLE);
1066d7024191SGrygorii Strashko 
1067d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt en");
1068d7024191SGrygorii Strashko 	return 0;
1069d7024191SGrygorii Strashko }
1070d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_enable_rx_chn);
1071d7024191SGrygorii Strashko 
1072d7024191SGrygorii Strashko void k3_udma_glue_disable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn)
1073d7024191SGrygorii Strashko {
1074d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis1");
1075d7024191SGrygorii Strashko 
1076d7024191SGrygorii Strashko 	xudma_rchanrt_write(rx_chn->udma_rchanx,
1077bc7e5523SPeter Ujfalusi 			    UDMA_CHAN_RT_PEER_RT_EN_REG, 0);
1078bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG, 0);
1079d7024191SGrygorii Strashko 
1080d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis2");
1081d7024191SGrygorii Strashko }
1082d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_disable_rx_chn);
1083d7024191SGrygorii Strashko 
1084d7024191SGrygorii Strashko void k3_udma_glue_tdown_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1085d7024191SGrygorii Strashko 			       bool sync)
1086d7024191SGrygorii Strashko {
1087d7024191SGrygorii Strashko 	int i = 0;
1088d7024191SGrygorii Strashko 	u32 val;
1089d7024191SGrygorii Strashko 
1090d7024191SGrygorii Strashko 	if (rx_chn->remote)
1091d7024191SGrygorii Strashko 		return;
1092d7024191SGrygorii Strashko 
1093d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown1");
1094d7024191SGrygorii Strashko 
1095bc7e5523SPeter Ujfalusi 	xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG,
1096d7024191SGrygorii Strashko 			    UDMA_PEER_RT_EN_ENABLE | UDMA_PEER_RT_EN_TEARDOWN);
1097d7024191SGrygorii Strashko 
1098bc7e5523SPeter Ujfalusi 	val = xudma_rchanrt_read(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG);
1099d7024191SGrygorii Strashko 
1100d7024191SGrygorii Strashko 	while (sync && (val & UDMA_CHAN_RT_CTL_EN)) {
1101d7024191SGrygorii Strashko 		val = xudma_rchanrt_read(rx_chn->udma_rchanx,
1102bc7e5523SPeter Ujfalusi 					 UDMA_CHAN_RT_CTL_REG);
1103d7024191SGrygorii Strashko 		udelay(1);
1104d7024191SGrygorii Strashko 		if (i > K3_UDMAX_TDOWN_TIMEOUT_US) {
1105d7024191SGrygorii Strashko 			dev_err(rx_chn->common.dev, "RX tdown timeout\n");
1106d7024191SGrygorii Strashko 			break;
1107d7024191SGrygorii Strashko 		}
1108d7024191SGrygorii Strashko 		i++;
1109d7024191SGrygorii Strashko 	}
1110d7024191SGrygorii Strashko 
1111d7024191SGrygorii Strashko 	val = xudma_rchanrt_read(rx_chn->udma_rchanx,
1112bc7e5523SPeter Ujfalusi 				 UDMA_CHAN_RT_PEER_RT_EN_REG);
1113d7024191SGrygorii Strashko 	if (sync && (val & UDMA_PEER_RT_EN_ENABLE))
1114d7024191SGrygorii Strashko 		dev_err(rx_chn->common.dev, "TX tdown peer not stopped\n");
1115d7024191SGrygorii Strashko 	k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown2");
1116d7024191SGrygorii Strashko }
1117d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tdown_rx_chn);
1118d7024191SGrygorii Strashko 
1119d7024191SGrygorii Strashko void k3_udma_glue_reset_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1120d7024191SGrygorii Strashko 		u32 flow_num, void *data,
1121d7024191SGrygorii Strashko 		void (*cleanup)(void *data, dma_addr_t desc_dma), bool skip_fdq)
1122d7024191SGrygorii Strashko {
1123d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
1124d7024191SGrygorii Strashko 	struct device *dev = rx_chn->common.dev;
1125d7024191SGrygorii Strashko 	dma_addr_t desc_dma;
1126d7024191SGrygorii Strashko 	int occ_rx, i, ret;
1127d7024191SGrygorii Strashko 
1128d7024191SGrygorii Strashko 	/* reset RXCQ as it is not input for udma - expected to be empty */
1129d7024191SGrygorii Strashko 	occ_rx = k3_ringacc_ring_get_occ(flow->ringrx);
1130d7024191SGrygorii Strashko 	dev_dbg(dev, "RX reset flow %u occ_rx %u\n", flow_num, occ_rx);
1131d7024191SGrygorii Strashko 	if (flow->ringrx)
1132d7024191SGrygorii Strashko 		k3_ringacc_ring_reset(flow->ringrx);
1133d7024191SGrygorii Strashko 
1134d7024191SGrygorii Strashko 	/* Skip RX FDQ in case one FDQ is used for the set of flows */
1135d7024191SGrygorii Strashko 	if (skip_fdq)
1136d7024191SGrygorii Strashko 		return;
1137d7024191SGrygorii Strashko 
1138d7024191SGrygorii Strashko 	/*
1139d7024191SGrygorii Strashko 	 * RX FDQ reset need to be special way as it is input for udma and its
1140d7024191SGrygorii Strashko 	 * state cached by udma, so:
1141d7024191SGrygorii Strashko 	 * 1) save RX FDQ occ
1142d7024191SGrygorii Strashko 	 * 2) clean up RX FDQ and call callback .cleanup() for each desc
1143d7024191SGrygorii Strashko 	 * 3) reset RX FDQ in a special way
1144d7024191SGrygorii Strashko 	 */
1145d7024191SGrygorii Strashko 	occ_rx = k3_ringacc_ring_get_occ(flow->ringrxfdq);
1146d7024191SGrygorii Strashko 	dev_dbg(dev, "RX reset flow %u occ_rx_fdq %u\n", flow_num, occ_rx);
1147d7024191SGrygorii Strashko 
1148d7024191SGrygorii Strashko 	for (i = 0; i < occ_rx; i++) {
1149d7024191SGrygorii Strashko 		ret = k3_ringacc_ring_pop(flow->ringrxfdq, &desc_dma);
1150d7024191SGrygorii Strashko 		if (ret) {
1151d7024191SGrygorii Strashko 			dev_err(dev, "RX reset pop %d\n", ret);
1152d7024191SGrygorii Strashko 			break;
1153d7024191SGrygorii Strashko 		}
1154d7024191SGrygorii Strashko 		cleanup(data, desc_dma);
1155d7024191SGrygorii Strashko 	}
1156d7024191SGrygorii Strashko 
1157d7024191SGrygorii Strashko 	k3_ringacc_ring_reset_dma(flow->ringrxfdq, occ_rx);
1158d7024191SGrygorii Strashko }
1159d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_reset_rx_chn);
1160d7024191SGrygorii Strashko 
1161d7024191SGrygorii Strashko int k3_udma_glue_push_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1162d7024191SGrygorii Strashko 			     u32 flow_num, struct cppi5_host_desc_t *desc_rx,
1163d7024191SGrygorii Strashko 			     dma_addr_t desc_dma)
1164d7024191SGrygorii Strashko {
1165d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
1166d7024191SGrygorii Strashko 
1167d7024191SGrygorii Strashko 	return k3_ringacc_ring_push(flow->ringrxfdq, &desc_dma);
1168d7024191SGrygorii Strashko }
1169d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_push_rx_chn);
1170d7024191SGrygorii Strashko 
1171d7024191SGrygorii Strashko int k3_udma_glue_pop_rx_chn(struct k3_udma_glue_rx_channel *rx_chn,
1172d7024191SGrygorii Strashko 			    u32 flow_num, dma_addr_t *desc_dma)
1173d7024191SGrygorii Strashko {
1174d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num];
1175d7024191SGrygorii Strashko 
1176d7024191SGrygorii Strashko 	return k3_ringacc_ring_pop(flow->ringrx, desc_dma);
1177d7024191SGrygorii Strashko }
1178d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_pop_rx_chn);
1179d7024191SGrygorii Strashko 
1180d7024191SGrygorii Strashko int k3_udma_glue_rx_get_irq(struct k3_udma_glue_rx_channel *rx_chn,
1181d7024191SGrygorii Strashko 			    u32 flow_num)
1182d7024191SGrygorii Strashko {
1183d7024191SGrygorii Strashko 	struct k3_udma_glue_rx_flow *flow;
1184d7024191SGrygorii Strashko 
1185d7024191SGrygorii Strashko 	flow = &rx_chn->flows[flow_num];
1186d7024191SGrygorii Strashko 
1187d7024191SGrygorii Strashko 	flow->virq = k3_ringacc_get_ring_irq_num(flow->ringrx);
1188d7024191SGrygorii Strashko 
1189d7024191SGrygorii Strashko 	return flow->virq;
1190d7024191SGrygorii Strashko }
1191d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_irq);
1192