18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * K3 NAVSS DMA glue interface 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com 68c2ecf20Sopenharmony_ci * 78c2ecf20Sopenharmony_ci */ 88c2ecf20Sopenharmony_ci 98c2ecf20Sopenharmony_ci#include <linux/atomic.h> 108c2ecf20Sopenharmony_ci#include <linux/delay.h> 118c2ecf20Sopenharmony_ci#include <linux/dma-mapping.h> 128c2ecf20Sopenharmony_ci#include <linux/io.h> 138c2ecf20Sopenharmony_ci#include <linux/init.h> 148c2ecf20Sopenharmony_ci#include <linux/of.h> 158c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 168c2ecf20Sopenharmony_ci#include <linux/soc/ti/k3-ringacc.h> 178c2ecf20Sopenharmony_ci#include <linux/dma/ti-cppi5.h> 188c2ecf20Sopenharmony_ci#include <linux/dma/k3-udma-glue.h> 198c2ecf20Sopenharmony_ci 208c2ecf20Sopenharmony_ci#include "k3-udma.h" 218c2ecf20Sopenharmony_ci#include "k3-psil-priv.h" 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_cistruct k3_udma_glue_common { 248c2ecf20Sopenharmony_ci struct device *dev; 258c2ecf20Sopenharmony_ci struct udma_dev *udmax; 268c2ecf20Sopenharmony_ci const struct udma_tisci_rm *tisci_rm; 278c2ecf20Sopenharmony_ci struct k3_ringacc *ringacc; 288c2ecf20Sopenharmony_ci u32 src_thread; 298c2ecf20Sopenharmony_ci u32 dst_thread; 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci u32 hdesc_size; 328c2ecf20Sopenharmony_ci bool epib; 338c2ecf20Sopenharmony_ci u32 psdata_size; 348c2ecf20Sopenharmony_ci u32 swdata_size; 358c2ecf20Sopenharmony_ci u32 atype; 368c2ecf20Sopenharmony_ci}; 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_cistruct k3_udma_glue_tx_channel { 398c2ecf20Sopenharmony_ci struct k3_udma_glue_common common; 408c2ecf20Sopenharmony_ci 418c2ecf20Sopenharmony_ci struct udma_tchan *udma_tchanx; 428c2ecf20Sopenharmony_ci int udma_tchan_id; 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ci struct k3_ring *ringtx; 458c2ecf20Sopenharmony_ci struct k3_ring *ringtxcq; 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_ci bool psil_paired; 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_ci int virq; 508c2ecf20Sopenharmony_ci 518c2ecf20Sopenharmony_ci atomic_t free_pkts; 528c2ecf20Sopenharmony_ci bool tx_pause_on_err; 538c2ecf20Sopenharmony_ci bool tx_filt_einfo; 548c2ecf20Sopenharmony_ci bool tx_filt_pswords; 558c2ecf20Sopenharmony_ci bool tx_supr_tdpkt; 568c2ecf20Sopenharmony_ci}; 578c2ecf20Sopenharmony_ci 588c2ecf20Sopenharmony_cistruct k3_udma_glue_rx_flow { 598c2ecf20Sopenharmony_ci struct udma_rflow *udma_rflow; 608c2ecf20Sopenharmony_ci int udma_rflow_id; 618c2ecf20Sopenharmony_ci struct k3_ring *ringrx; 628c2ecf20Sopenharmony_ci struct k3_ring *ringrxfdq; 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci int virq; 658c2ecf20Sopenharmony_ci}; 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_cistruct k3_udma_glue_rx_channel { 688c2ecf20Sopenharmony_ci struct k3_udma_glue_common common; 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ci struct udma_rchan *udma_rchanx; 718c2ecf20Sopenharmony_ci int udma_rchan_id; 728c2ecf20Sopenharmony_ci bool remote; 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_ci bool psil_paired; 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci u32 swdata_size; 778c2ecf20Sopenharmony_ci int flow_id_base; 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flows; 808c2ecf20Sopenharmony_ci u32 flow_num; 818c2ecf20Sopenharmony_ci u32 flows_ready; 828c2ecf20Sopenharmony_ci}; 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_ci#define K3_UDMAX_TDOWN_TIMEOUT_US 1000 858c2ecf20Sopenharmony_ci 868c2ecf20Sopenharmony_cistatic int of_k3_udma_glue_parse(struct device_node *udmax_np, 878c2ecf20Sopenharmony_ci struct k3_udma_glue_common *common) 888c2ecf20Sopenharmony_ci{ 898c2ecf20Sopenharmony_ci common->ringacc = of_k3_ringacc_get_by_phandle(udmax_np, 908c2ecf20Sopenharmony_ci "ti,ringacc"); 918c2ecf20Sopenharmony_ci if (IS_ERR(common->ringacc)) 928c2ecf20Sopenharmony_ci return PTR_ERR(common->ringacc); 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_ci common->udmax = of_xudma_dev_get(udmax_np, NULL); 958c2ecf20Sopenharmony_ci if (IS_ERR(common->udmax)) 968c2ecf20Sopenharmony_ci return PTR_ERR(common->udmax); 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_ci common->tisci_rm = xudma_dev_get_tisci_rm(common->udmax); 998c2ecf20Sopenharmony_ci 1008c2ecf20Sopenharmony_ci return 0; 1018c2ecf20Sopenharmony_ci} 1028c2ecf20Sopenharmony_ci 1038c2ecf20Sopenharmony_cistatic int of_k3_udma_glue_parse_chn(struct device_node *chn_np, 1048c2ecf20Sopenharmony_ci const char *name, struct k3_udma_glue_common *common, 1058c2ecf20Sopenharmony_ci bool tx_chn) 1068c2ecf20Sopenharmony_ci{ 1078c2ecf20Sopenharmony_ci struct psil_endpoint_config *ep_config; 1088c2ecf20Sopenharmony_ci struct of_phandle_args dma_spec; 1098c2ecf20Sopenharmony_ci u32 thread_id; 1108c2ecf20Sopenharmony_ci int ret = 0; 1118c2ecf20Sopenharmony_ci int index; 1128c2ecf20Sopenharmony_ci 1138c2ecf20Sopenharmony_ci if (unlikely(!name)) 1148c2ecf20Sopenharmony_ci return -EINVAL; 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_ci index = of_property_match_string(chn_np, "dma-names", name); 1178c2ecf20Sopenharmony_ci if (index < 0) 1188c2ecf20Sopenharmony_ci return index; 1198c2ecf20Sopenharmony_ci 1208c2ecf20Sopenharmony_ci if (of_parse_phandle_with_args(chn_np, "dmas", "#dma-cells", index, 1218c2ecf20Sopenharmony_ci &dma_spec)) 1228c2ecf20Sopenharmony_ci return -ENOENT; 1238c2ecf20Sopenharmony_ci 1248c2ecf20Sopenharmony_ci thread_id = dma_spec.args[0]; 1258c2ecf20Sopenharmony_ci if (dma_spec.args_count == 2) { 1268c2ecf20Sopenharmony_ci if (dma_spec.args[1] > 2) { 1278c2ecf20Sopenharmony_ci dev_err(common->dev, "Invalid channel atype: %u\n", 1288c2ecf20Sopenharmony_ci dma_spec.args[1]); 1298c2ecf20Sopenharmony_ci ret = -EINVAL; 1308c2ecf20Sopenharmony_ci goto out_put_spec; 1318c2ecf20Sopenharmony_ci } 1328c2ecf20Sopenharmony_ci common->atype = dma_spec.args[1]; 1338c2ecf20Sopenharmony_ci } 1348c2ecf20Sopenharmony_ci 1358c2ecf20Sopenharmony_ci if (tx_chn && !(thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) { 1368c2ecf20Sopenharmony_ci ret = -EINVAL; 1378c2ecf20Sopenharmony_ci goto out_put_spec; 1388c2ecf20Sopenharmony_ci } 1398c2ecf20Sopenharmony_ci 1408c2ecf20Sopenharmony_ci if (!tx_chn && (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) { 1418c2ecf20Sopenharmony_ci ret = -EINVAL; 1428c2ecf20Sopenharmony_ci goto out_put_spec; 1438c2ecf20Sopenharmony_ci } 1448c2ecf20Sopenharmony_ci 1458c2ecf20Sopenharmony_ci /* get psil endpoint config */ 1468c2ecf20Sopenharmony_ci ep_config = psil_get_ep_config(thread_id); 1478c2ecf20Sopenharmony_ci if (IS_ERR(ep_config)) { 1488c2ecf20Sopenharmony_ci dev_err(common->dev, 1498c2ecf20Sopenharmony_ci "No configuration for psi-l thread 0x%04x\n", 1508c2ecf20Sopenharmony_ci thread_id); 1518c2ecf20Sopenharmony_ci ret = PTR_ERR(ep_config); 1528c2ecf20Sopenharmony_ci goto out_put_spec; 1538c2ecf20Sopenharmony_ci } 1548c2ecf20Sopenharmony_ci 1558c2ecf20Sopenharmony_ci common->epib = ep_config->needs_epib; 1568c2ecf20Sopenharmony_ci common->psdata_size = ep_config->psd_size; 1578c2ecf20Sopenharmony_ci 1588c2ecf20Sopenharmony_ci if (tx_chn) 1598c2ecf20Sopenharmony_ci common->dst_thread = thread_id; 1608c2ecf20Sopenharmony_ci else 1618c2ecf20Sopenharmony_ci common->src_thread = thread_id; 1628c2ecf20Sopenharmony_ci 1638c2ecf20Sopenharmony_ci ret = of_k3_udma_glue_parse(dma_spec.np, common); 1648c2ecf20Sopenharmony_ci 1658c2ecf20Sopenharmony_ciout_put_spec: 1668c2ecf20Sopenharmony_ci of_node_put(dma_spec.np); 1678c2ecf20Sopenharmony_ci return ret; 1688c2ecf20Sopenharmony_ci}; 1698c2ecf20Sopenharmony_ci 1708c2ecf20Sopenharmony_cistatic void k3_udma_glue_dump_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 1718c2ecf20Sopenharmony_ci{ 1728c2ecf20Sopenharmony_ci struct device *dev = tx_chn->common.dev; 1738c2ecf20Sopenharmony_ci 1748c2ecf20Sopenharmony_ci dev_dbg(dev, "dump_tx_chn:\n" 1758c2ecf20Sopenharmony_ci "udma_tchan_id: %d\n" 1768c2ecf20Sopenharmony_ci "src_thread: %08x\n" 1778c2ecf20Sopenharmony_ci "dst_thread: %08x\n", 1788c2ecf20Sopenharmony_ci tx_chn->udma_tchan_id, 1798c2ecf20Sopenharmony_ci tx_chn->common.src_thread, 1808c2ecf20Sopenharmony_ci tx_chn->common.dst_thread); 1818c2ecf20Sopenharmony_ci} 1828c2ecf20Sopenharmony_ci 1838c2ecf20Sopenharmony_cistatic void k3_udma_glue_dump_tx_rt_chn(struct k3_udma_glue_tx_channel *chn, 1848c2ecf20Sopenharmony_ci char *mark) 1858c2ecf20Sopenharmony_ci{ 1868c2ecf20Sopenharmony_ci struct device *dev = chn->common.dev; 1878c2ecf20Sopenharmony_ci 1888c2ecf20Sopenharmony_ci dev_dbg(dev, "=== dump ===> %s\n", mark); 1898c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG, 1908c2ecf20Sopenharmony_ci xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG)); 1918c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG, 1928c2ecf20Sopenharmony_ci xudma_tchanrt_read(chn->udma_tchanx, 1938c2ecf20Sopenharmony_ci UDMA_CHAN_RT_PEER_RT_EN_REG)); 1948c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG, 1958c2ecf20Sopenharmony_ci xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_PCNT_REG)); 1968c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG, 1978c2ecf20Sopenharmony_ci xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_BCNT_REG)); 1988c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG, 1998c2ecf20Sopenharmony_ci xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_SBCNT_REG)); 2008c2ecf20Sopenharmony_ci} 2018c2ecf20Sopenharmony_ci 2028c2ecf20Sopenharmony_cistatic int k3_udma_glue_cfg_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 2038c2ecf20Sopenharmony_ci{ 2048c2ecf20Sopenharmony_ci const struct udma_tisci_rm *tisci_rm = tx_chn->common.tisci_rm; 2058c2ecf20Sopenharmony_ci struct ti_sci_msg_rm_udmap_tx_ch_cfg req; 2068c2ecf20Sopenharmony_ci 2078c2ecf20Sopenharmony_ci memset(&req, 0, sizeof(req)); 2088c2ecf20Sopenharmony_ci 2098c2ecf20Sopenharmony_ci req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_PAUSE_ON_ERR_VALID | 2108c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_EINFO_VALID | 2118c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_PSWORDS_VALID | 2128c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID | 2138c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_SUPR_TDPKT_VALID | 2148c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID | 2158c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID | 2168c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID; 2178c2ecf20Sopenharmony_ci req.nav_id = tisci_rm->tisci_dev_id; 2188c2ecf20Sopenharmony_ci req.index = tx_chn->udma_tchan_id; 2198c2ecf20Sopenharmony_ci if (tx_chn->tx_pause_on_err) 2208c2ecf20Sopenharmony_ci req.tx_pause_on_err = 1; 2218c2ecf20Sopenharmony_ci if (tx_chn->tx_filt_einfo) 2228c2ecf20Sopenharmony_ci req.tx_filt_einfo = 1; 2238c2ecf20Sopenharmony_ci if (tx_chn->tx_filt_pswords) 2248c2ecf20Sopenharmony_ci req.tx_filt_pswords = 1; 2258c2ecf20Sopenharmony_ci req.tx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR; 2268c2ecf20Sopenharmony_ci if (tx_chn->tx_supr_tdpkt) 2278c2ecf20Sopenharmony_ci req.tx_supr_tdpkt = 1; 2288c2ecf20Sopenharmony_ci req.tx_fetch_size = tx_chn->common.hdesc_size >> 2; 2298c2ecf20Sopenharmony_ci req.txcq_qnum = k3_ringacc_get_ring_id(tx_chn->ringtxcq); 2308c2ecf20Sopenharmony_ci req.tx_atype = tx_chn->common.atype; 2318c2ecf20Sopenharmony_ci 2328c2ecf20Sopenharmony_ci return tisci_rm->tisci_udmap_ops->tx_ch_cfg(tisci_rm->tisci, &req); 2338c2ecf20Sopenharmony_ci} 2348c2ecf20Sopenharmony_ci 2358c2ecf20Sopenharmony_cistruct k3_udma_glue_tx_channel *k3_udma_glue_request_tx_chn(struct device *dev, 2368c2ecf20Sopenharmony_ci const char *name, struct k3_udma_glue_tx_channel_cfg *cfg) 2378c2ecf20Sopenharmony_ci{ 2388c2ecf20Sopenharmony_ci struct k3_udma_glue_tx_channel *tx_chn; 2398c2ecf20Sopenharmony_ci int ret; 2408c2ecf20Sopenharmony_ci 2418c2ecf20Sopenharmony_ci tx_chn = devm_kzalloc(dev, sizeof(*tx_chn), GFP_KERNEL); 2428c2ecf20Sopenharmony_ci if (!tx_chn) 2438c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 2448c2ecf20Sopenharmony_ci 2458c2ecf20Sopenharmony_ci tx_chn->common.dev = dev; 2468c2ecf20Sopenharmony_ci tx_chn->common.swdata_size = cfg->swdata_size; 2478c2ecf20Sopenharmony_ci tx_chn->tx_pause_on_err = cfg->tx_pause_on_err; 2488c2ecf20Sopenharmony_ci tx_chn->tx_filt_einfo = cfg->tx_filt_einfo; 2498c2ecf20Sopenharmony_ci tx_chn->tx_filt_pswords = cfg->tx_filt_pswords; 2508c2ecf20Sopenharmony_ci tx_chn->tx_supr_tdpkt = cfg->tx_supr_tdpkt; 2518c2ecf20Sopenharmony_ci 2528c2ecf20Sopenharmony_ci /* parse of udmap channel */ 2538c2ecf20Sopenharmony_ci ret = of_k3_udma_glue_parse_chn(dev->of_node, name, 2548c2ecf20Sopenharmony_ci &tx_chn->common, true); 2558c2ecf20Sopenharmony_ci if (ret) 2568c2ecf20Sopenharmony_ci goto err; 2578c2ecf20Sopenharmony_ci 2588c2ecf20Sopenharmony_ci tx_chn->common.hdesc_size = cppi5_hdesc_calc_size(tx_chn->common.epib, 2598c2ecf20Sopenharmony_ci tx_chn->common.psdata_size, 2608c2ecf20Sopenharmony_ci tx_chn->common.swdata_size); 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_ci /* request and cfg UDMAP TX channel */ 2638c2ecf20Sopenharmony_ci tx_chn->udma_tchanx = xudma_tchan_get(tx_chn->common.udmax, -1); 2648c2ecf20Sopenharmony_ci if (IS_ERR(tx_chn->udma_tchanx)) { 2658c2ecf20Sopenharmony_ci ret = PTR_ERR(tx_chn->udma_tchanx); 2668c2ecf20Sopenharmony_ci dev_err(dev, "UDMAX tchanx get err %d\n", ret); 2678c2ecf20Sopenharmony_ci goto err; 2688c2ecf20Sopenharmony_ci } 2698c2ecf20Sopenharmony_ci tx_chn->udma_tchan_id = xudma_tchan_get_id(tx_chn->udma_tchanx); 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_ci atomic_set(&tx_chn->free_pkts, cfg->txcq_cfg.size); 2728c2ecf20Sopenharmony_ci 2738c2ecf20Sopenharmony_ci /* request and cfg rings */ 2748c2ecf20Sopenharmony_ci ret = k3_ringacc_request_rings_pair(tx_chn->common.ringacc, 2758c2ecf20Sopenharmony_ci tx_chn->udma_tchan_id, -1, 2768c2ecf20Sopenharmony_ci &tx_chn->ringtx, 2778c2ecf20Sopenharmony_ci &tx_chn->ringtxcq); 2788c2ecf20Sopenharmony_ci if (ret) { 2798c2ecf20Sopenharmony_ci dev_err(dev, "Failed to get TX/TXCQ rings %d\n", ret); 2808c2ecf20Sopenharmony_ci goto err; 2818c2ecf20Sopenharmony_ci } 2828c2ecf20Sopenharmony_ci 2838c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_cfg(tx_chn->ringtx, &cfg->tx_cfg); 2848c2ecf20Sopenharmony_ci if (ret) { 2858c2ecf20Sopenharmony_ci dev_err(dev, "Failed to cfg ringtx %d\n", ret); 2868c2ecf20Sopenharmony_ci goto err; 2878c2ecf20Sopenharmony_ci } 2888c2ecf20Sopenharmony_ci 2898c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_cfg(tx_chn->ringtxcq, &cfg->txcq_cfg); 2908c2ecf20Sopenharmony_ci if (ret) { 2918c2ecf20Sopenharmony_ci dev_err(dev, "Failed to cfg ringtx %d\n", ret); 2928c2ecf20Sopenharmony_ci goto err; 2938c2ecf20Sopenharmony_ci } 2948c2ecf20Sopenharmony_ci 2958c2ecf20Sopenharmony_ci /* request and cfg psi-l */ 2968c2ecf20Sopenharmony_ci tx_chn->common.src_thread = 2978c2ecf20Sopenharmony_ci xudma_dev_get_psil_base(tx_chn->common.udmax) + 2988c2ecf20Sopenharmony_ci tx_chn->udma_tchan_id; 2998c2ecf20Sopenharmony_ci 3008c2ecf20Sopenharmony_ci ret = k3_udma_glue_cfg_tx_chn(tx_chn); 3018c2ecf20Sopenharmony_ci if (ret) { 3028c2ecf20Sopenharmony_ci dev_err(dev, "Failed to cfg tchan %d\n", ret); 3038c2ecf20Sopenharmony_ci goto err; 3048c2ecf20Sopenharmony_ci } 3058c2ecf20Sopenharmony_ci 3068c2ecf20Sopenharmony_ci ret = xudma_navss_psil_pair(tx_chn->common.udmax, 3078c2ecf20Sopenharmony_ci tx_chn->common.src_thread, 3088c2ecf20Sopenharmony_ci tx_chn->common.dst_thread); 3098c2ecf20Sopenharmony_ci if (ret) { 3108c2ecf20Sopenharmony_ci dev_err(dev, "PSI-L request err %d\n", ret); 3118c2ecf20Sopenharmony_ci goto err; 3128c2ecf20Sopenharmony_ci } 3138c2ecf20Sopenharmony_ci 3148c2ecf20Sopenharmony_ci tx_chn->psil_paired = true; 3158c2ecf20Sopenharmony_ci 3168c2ecf20Sopenharmony_ci /* reset TX RT registers */ 3178c2ecf20Sopenharmony_ci k3_udma_glue_disable_tx_chn(tx_chn); 3188c2ecf20Sopenharmony_ci 3198c2ecf20Sopenharmony_ci k3_udma_glue_dump_tx_chn(tx_chn); 3208c2ecf20Sopenharmony_ci 3218c2ecf20Sopenharmony_ci return tx_chn; 3228c2ecf20Sopenharmony_ci 3238c2ecf20Sopenharmony_cierr: 3248c2ecf20Sopenharmony_ci k3_udma_glue_release_tx_chn(tx_chn); 3258c2ecf20Sopenharmony_ci return ERR_PTR(ret); 3268c2ecf20Sopenharmony_ci} 3278c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_request_tx_chn); 3288c2ecf20Sopenharmony_ci 3298c2ecf20Sopenharmony_civoid k3_udma_glue_release_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 3308c2ecf20Sopenharmony_ci{ 3318c2ecf20Sopenharmony_ci if (tx_chn->psil_paired) { 3328c2ecf20Sopenharmony_ci xudma_navss_psil_unpair(tx_chn->common.udmax, 3338c2ecf20Sopenharmony_ci tx_chn->common.src_thread, 3348c2ecf20Sopenharmony_ci tx_chn->common.dst_thread); 3358c2ecf20Sopenharmony_ci tx_chn->psil_paired = false; 3368c2ecf20Sopenharmony_ci } 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_ci if (!IS_ERR_OR_NULL(tx_chn->udma_tchanx)) 3398c2ecf20Sopenharmony_ci xudma_tchan_put(tx_chn->common.udmax, 3408c2ecf20Sopenharmony_ci tx_chn->udma_tchanx); 3418c2ecf20Sopenharmony_ci 3428c2ecf20Sopenharmony_ci if (tx_chn->ringtxcq) 3438c2ecf20Sopenharmony_ci k3_ringacc_ring_free(tx_chn->ringtxcq); 3448c2ecf20Sopenharmony_ci 3458c2ecf20Sopenharmony_ci if (tx_chn->ringtx) 3468c2ecf20Sopenharmony_ci k3_ringacc_ring_free(tx_chn->ringtx); 3478c2ecf20Sopenharmony_ci} 3488c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_release_tx_chn); 3498c2ecf20Sopenharmony_ci 3508c2ecf20Sopenharmony_ciint k3_udma_glue_push_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 3518c2ecf20Sopenharmony_ci struct cppi5_host_desc_t *desc_tx, 3528c2ecf20Sopenharmony_ci dma_addr_t desc_dma) 3538c2ecf20Sopenharmony_ci{ 3548c2ecf20Sopenharmony_ci u32 ringtxcq_id; 3558c2ecf20Sopenharmony_ci 3568c2ecf20Sopenharmony_ci if (!atomic_add_unless(&tx_chn->free_pkts, -1, 0)) 3578c2ecf20Sopenharmony_ci return -ENOMEM; 3588c2ecf20Sopenharmony_ci 3598c2ecf20Sopenharmony_ci ringtxcq_id = k3_ringacc_get_ring_id(tx_chn->ringtxcq); 3608c2ecf20Sopenharmony_ci cppi5_desc_set_retpolicy(&desc_tx->hdr, 0, ringtxcq_id); 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci return k3_ringacc_ring_push(tx_chn->ringtx, &desc_dma); 3638c2ecf20Sopenharmony_ci} 3648c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_push_tx_chn); 3658c2ecf20Sopenharmony_ci 3668c2ecf20Sopenharmony_ciint k3_udma_glue_pop_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 3678c2ecf20Sopenharmony_ci dma_addr_t *desc_dma) 3688c2ecf20Sopenharmony_ci{ 3698c2ecf20Sopenharmony_ci int ret; 3708c2ecf20Sopenharmony_ci 3718c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_pop(tx_chn->ringtxcq, desc_dma); 3728c2ecf20Sopenharmony_ci if (!ret) 3738c2ecf20Sopenharmony_ci atomic_inc(&tx_chn->free_pkts); 3748c2ecf20Sopenharmony_ci 3758c2ecf20Sopenharmony_ci return ret; 3768c2ecf20Sopenharmony_ci} 3778c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_pop_tx_chn); 3788c2ecf20Sopenharmony_ci 3798c2ecf20Sopenharmony_ciint k3_udma_glue_enable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 3808c2ecf20Sopenharmony_ci{ 3818c2ecf20Sopenharmony_ci xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_PEER_RT_EN_REG, 3828c2ecf20Sopenharmony_ci UDMA_PEER_RT_EN_ENABLE); 3838c2ecf20Sopenharmony_ci 3848c2ecf20Sopenharmony_ci xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 3858c2ecf20Sopenharmony_ci UDMA_CHAN_RT_CTL_EN); 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn en"); 3888c2ecf20Sopenharmony_ci return 0; 3898c2ecf20Sopenharmony_ci} 3908c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_enable_tx_chn); 3918c2ecf20Sopenharmony_ci 3928c2ecf20Sopenharmony_civoid k3_udma_glue_disable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 3938c2ecf20Sopenharmony_ci{ 3948c2ecf20Sopenharmony_ci k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis1"); 3958c2ecf20Sopenharmony_ci 3968c2ecf20Sopenharmony_ci xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 0); 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci xudma_tchanrt_write(tx_chn->udma_tchanx, 3998c2ecf20Sopenharmony_ci UDMA_CHAN_RT_PEER_RT_EN_REG, 0); 4008c2ecf20Sopenharmony_ci k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis2"); 4018c2ecf20Sopenharmony_ci} 4028c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_disable_tx_chn); 4038c2ecf20Sopenharmony_ci 4048c2ecf20Sopenharmony_civoid k3_udma_glue_tdown_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 4058c2ecf20Sopenharmony_ci bool sync) 4068c2ecf20Sopenharmony_ci{ 4078c2ecf20Sopenharmony_ci int i = 0; 4088c2ecf20Sopenharmony_ci u32 val; 4098c2ecf20Sopenharmony_ci 4108c2ecf20Sopenharmony_ci k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown1"); 4118c2ecf20Sopenharmony_ci 4128c2ecf20Sopenharmony_ci xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 4138c2ecf20Sopenharmony_ci UDMA_CHAN_RT_CTL_EN | UDMA_CHAN_RT_CTL_TDOWN); 4148c2ecf20Sopenharmony_ci 4158c2ecf20Sopenharmony_ci val = xudma_tchanrt_read(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG); 4168c2ecf20Sopenharmony_ci 4178c2ecf20Sopenharmony_ci while (sync && (val & UDMA_CHAN_RT_CTL_EN)) { 4188c2ecf20Sopenharmony_ci val = xudma_tchanrt_read(tx_chn->udma_tchanx, 4198c2ecf20Sopenharmony_ci UDMA_CHAN_RT_CTL_REG); 4208c2ecf20Sopenharmony_ci udelay(1); 4218c2ecf20Sopenharmony_ci if (i > K3_UDMAX_TDOWN_TIMEOUT_US) { 4228c2ecf20Sopenharmony_ci dev_err(tx_chn->common.dev, "TX tdown timeout\n"); 4238c2ecf20Sopenharmony_ci break; 4248c2ecf20Sopenharmony_ci } 4258c2ecf20Sopenharmony_ci i++; 4268c2ecf20Sopenharmony_ci } 4278c2ecf20Sopenharmony_ci 4288c2ecf20Sopenharmony_ci val = xudma_tchanrt_read(tx_chn->udma_tchanx, 4298c2ecf20Sopenharmony_ci UDMA_CHAN_RT_PEER_RT_EN_REG); 4308c2ecf20Sopenharmony_ci if (sync && (val & UDMA_PEER_RT_EN_ENABLE)) 4318c2ecf20Sopenharmony_ci dev_err(tx_chn->common.dev, "TX tdown peer not stopped\n"); 4328c2ecf20Sopenharmony_ci k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown2"); 4338c2ecf20Sopenharmony_ci} 4348c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_tdown_tx_chn); 4358c2ecf20Sopenharmony_ci 4368c2ecf20Sopenharmony_civoid k3_udma_glue_reset_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 4378c2ecf20Sopenharmony_ci void *data, 4388c2ecf20Sopenharmony_ci void (*cleanup)(void *data, dma_addr_t desc_dma)) 4398c2ecf20Sopenharmony_ci{ 4408c2ecf20Sopenharmony_ci dma_addr_t desc_dma; 4418c2ecf20Sopenharmony_ci int occ_tx, i, ret; 4428c2ecf20Sopenharmony_ci 4438c2ecf20Sopenharmony_ci /* reset TXCQ as it is not input for udma - expected to be empty */ 4448c2ecf20Sopenharmony_ci if (tx_chn->ringtxcq) 4458c2ecf20Sopenharmony_ci k3_ringacc_ring_reset(tx_chn->ringtxcq); 4468c2ecf20Sopenharmony_ci 4478c2ecf20Sopenharmony_ci /* 4488c2ecf20Sopenharmony_ci * TXQ reset need to be special way as it is input for udma and its 4498c2ecf20Sopenharmony_ci * state cached by udma, so: 4508c2ecf20Sopenharmony_ci * 1) save TXQ occ 4518c2ecf20Sopenharmony_ci * 2) clean up TXQ and call callback .cleanup() for each desc 4528c2ecf20Sopenharmony_ci * 3) reset TXQ in a special way 4538c2ecf20Sopenharmony_ci */ 4548c2ecf20Sopenharmony_ci occ_tx = k3_ringacc_ring_get_occ(tx_chn->ringtx); 4558c2ecf20Sopenharmony_ci dev_dbg(tx_chn->common.dev, "TX reset occ_tx %u\n", occ_tx); 4568c2ecf20Sopenharmony_ci 4578c2ecf20Sopenharmony_ci for (i = 0; i < occ_tx; i++) { 4588c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_pop(tx_chn->ringtx, &desc_dma); 4598c2ecf20Sopenharmony_ci if (ret) { 4608c2ecf20Sopenharmony_ci dev_err(tx_chn->common.dev, "TX reset pop %d\n", ret); 4618c2ecf20Sopenharmony_ci break; 4628c2ecf20Sopenharmony_ci } 4638c2ecf20Sopenharmony_ci cleanup(data, desc_dma); 4648c2ecf20Sopenharmony_ci } 4658c2ecf20Sopenharmony_ci 4668c2ecf20Sopenharmony_ci k3_ringacc_ring_reset_dma(tx_chn->ringtx, occ_tx); 4678c2ecf20Sopenharmony_ci} 4688c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_reset_tx_chn); 4698c2ecf20Sopenharmony_ci 4708c2ecf20Sopenharmony_ciu32 k3_udma_glue_tx_get_hdesc_size(struct k3_udma_glue_tx_channel *tx_chn) 4718c2ecf20Sopenharmony_ci{ 4728c2ecf20Sopenharmony_ci return tx_chn->common.hdesc_size; 4738c2ecf20Sopenharmony_ci} 4748c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_hdesc_size); 4758c2ecf20Sopenharmony_ci 4768c2ecf20Sopenharmony_ciu32 k3_udma_glue_tx_get_txcq_id(struct k3_udma_glue_tx_channel *tx_chn) 4778c2ecf20Sopenharmony_ci{ 4788c2ecf20Sopenharmony_ci return k3_ringacc_get_ring_id(tx_chn->ringtxcq); 4798c2ecf20Sopenharmony_ci} 4808c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_txcq_id); 4818c2ecf20Sopenharmony_ci 4828c2ecf20Sopenharmony_ciint k3_udma_glue_tx_get_irq(struct k3_udma_glue_tx_channel *tx_chn) 4838c2ecf20Sopenharmony_ci{ 4848c2ecf20Sopenharmony_ci tx_chn->virq = k3_ringacc_get_ring_irq_num(tx_chn->ringtxcq); 4858c2ecf20Sopenharmony_ci 4868c2ecf20Sopenharmony_ci return tx_chn->virq; 4878c2ecf20Sopenharmony_ci} 4888c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_irq); 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_cistatic int k3_udma_glue_cfg_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 4918c2ecf20Sopenharmony_ci{ 4928c2ecf20Sopenharmony_ci const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 4938c2ecf20Sopenharmony_ci struct ti_sci_msg_rm_udmap_rx_ch_cfg req; 4948c2ecf20Sopenharmony_ci int ret; 4958c2ecf20Sopenharmony_ci 4968c2ecf20Sopenharmony_ci memset(&req, 0, sizeof(req)); 4978c2ecf20Sopenharmony_ci 4988c2ecf20Sopenharmony_ci req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID | 4998c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID | 5008c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID | 5018c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_START_VALID | 5028c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_CNT_VALID | 5038c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID; 5048c2ecf20Sopenharmony_ci 5058c2ecf20Sopenharmony_ci req.nav_id = tisci_rm->tisci_dev_id; 5068c2ecf20Sopenharmony_ci req.index = rx_chn->udma_rchan_id; 5078c2ecf20Sopenharmony_ci req.rx_fetch_size = rx_chn->common.hdesc_size >> 2; 5088c2ecf20Sopenharmony_ci /* 5098c2ecf20Sopenharmony_ci * TODO: we can't support rxcq_qnum/RCHAN[a]_RCQ cfg with current sysfw 5108c2ecf20Sopenharmony_ci * and udmax impl, so just configure it to invalid value. 5118c2ecf20Sopenharmony_ci * req.rxcq_qnum = k3_ringacc_get_ring_id(rx_chn->flows[0].ringrx); 5128c2ecf20Sopenharmony_ci */ 5138c2ecf20Sopenharmony_ci req.rxcq_qnum = 0xFFFF; 5148c2ecf20Sopenharmony_ci if (rx_chn->flow_num && rx_chn->flow_id_base != rx_chn->udma_rchan_id) { 5158c2ecf20Sopenharmony_ci /* Default flow + extra ones */ 5168c2ecf20Sopenharmony_ci req.flowid_start = rx_chn->flow_id_base; 5178c2ecf20Sopenharmony_ci req.flowid_cnt = rx_chn->flow_num; 5188c2ecf20Sopenharmony_ci } 5198c2ecf20Sopenharmony_ci req.rx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR; 5208c2ecf20Sopenharmony_ci req.rx_atype = rx_chn->common.atype; 5218c2ecf20Sopenharmony_ci 5228c2ecf20Sopenharmony_ci ret = tisci_rm->tisci_udmap_ops->rx_ch_cfg(tisci_rm->tisci, &req); 5238c2ecf20Sopenharmony_ci if (ret) 5248c2ecf20Sopenharmony_ci dev_err(rx_chn->common.dev, "rchan%d cfg failed %d\n", 5258c2ecf20Sopenharmony_ci rx_chn->udma_rchan_id, ret); 5268c2ecf20Sopenharmony_ci 5278c2ecf20Sopenharmony_ci return ret; 5288c2ecf20Sopenharmony_ci} 5298c2ecf20Sopenharmony_ci 5308c2ecf20Sopenharmony_cistatic void k3_udma_glue_release_rx_flow(struct k3_udma_glue_rx_channel *rx_chn, 5318c2ecf20Sopenharmony_ci u32 flow_num) 5328c2ecf20Sopenharmony_ci{ 5338c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 5348c2ecf20Sopenharmony_ci 5358c2ecf20Sopenharmony_ci if (IS_ERR_OR_NULL(flow->udma_rflow)) 5368c2ecf20Sopenharmony_ci return; 5378c2ecf20Sopenharmony_ci 5388c2ecf20Sopenharmony_ci if (flow->ringrxfdq) 5398c2ecf20Sopenharmony_ci k3_ringacc_ring_free(flow->ringrxfdq); 5408c2ecf20Sopenharmony_ci 5418c2ecf20Sopenharmony_ci if (flow->ringrx) 5428c2ecf20Sopenharmony_ci k3_ringacc_ring_free(flow->ringrx); 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow); 5458c2ecf20Sopenharmony_ci flow->udma_rflow = NULL; 5468c2ecf20Sopenharmony_ci rx_chn->flows_ready--; 5478c2ecf20Sopenharmony_ci} 5488c2ecf20Sopenharmony_ci 5498c2ecf20Sopenharmony_cistatic int k3_udma_glue_cfg_rx_flow(struct k3_udma_glue_rx_channel *rx_chn, 5508c2ecf20Sopenharmony_ci u32 flow_idx, 5518c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow_cfg *flow_cfg) 5528c2ecf20Sopenharmony_ci{ 5538c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx]; 5548c2ecf20Sopenharmony_ci const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 5558c2ecf20Sopenharmony_ci struct device *dev = rx_chn->common.dev; 5568c2ecf20Sopenharmony_ci struct ti_sci_msg_rm_udmap_flow_cfg req; 5578c2ecf20Sopenharmony_ci int rx_ring_id; 5588c2ecf20Sopenharmony_ci int rx_ringfdq_id; 5598c2ecf20Sopenharmony_ci int ret = 0; 5608c2ecf20Sopenharmony_ci 5618c2ecf20Sopenharmony_ci flow->udma_rflow = xudma_rflow_get(rx_chn->common.udmax, 5628c2ecf20Sopenharmony_ci flow->udma_rflow_id); 5638c2ecf20Sopenharmony_ci if (IS_ERR(flow->udma_rflow)) { 5648c2ecf20Sopenharmony_ci ret = PTR_ERR(flow->udma_rflow); 5658c2ecf20Sopenharmony_ci dev_err(dev, "UDMAX rflow get err %d\n", ret); 5668c2ecf20Sopenharmony_ci return ret; 5678c2ecf20Sopenharmony_ci } 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_ci if (flow->udma_rflow_id != xudma_rflow_get_id(flow->udma_rflow)) { 5708c2ecf20Sopenharmony_ci ret = -ENODEV; 5718c2ecf20Sopenharmony_ci goto err_rflow_put; 5728c2ecf20Sopenharmony_ci } 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ci /* request and cfg rings */ 5758c2ecf20Sopenharmony_ci ret = k3_ringacc_request_rings_pair(rx_chn->common.ringacc, 5768c2ecf20Sopenharmony_ci flow_cfg->ring_rxfdq0_id, 5778c2ecf20Sopenharmony_ci flow_cfg->ring_rxq_id, 5788c2ecf20Sopenharmony_ci &flow->ringrxfdq, 5798c2ecf20Sopenharmony_ci &flow->ringrx); 5808c2ecf20Sopenharmony_ci if (ret) { 5818c2ecf20Sopenharmony_ci dev_err(dev, "Failed to get RX/RXFDQ rings %d\n", ret); 5828c2ecf20Sopenharmony_ci goto err_rflow_put; 5838c2ecf20Sopenharmony_ci } 5848c2ecf20Sopenharmony_ci 5858c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_cfg(flow->ringrx, &flow_cfg->rx_cfg); 5868c2ecf20Sopenharmony_ci if (ret) { 5878c2ecf20Sopenharmony_ci dev_err(dev, "Failed to cfg ringrx %d\n", ret); 5888c2ecf20Sopenharmony_ci goto err_ringrxfdq_free; 5898c2ecf20Sopenharmony_ci } 5908c2ecf20Sopenharmony_ci 5918c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_cfg(flow->ringrxfdq, &flow_cfg->rxfdq_cfg); 5928c2ecf20Sopenharmony_ci if (ret) { 5938c2ecf20Sopenharmony_ci dev_err(dev, "Failed to cfg ringrxfdq %d\n", ret); 5948c2ecf20Sopenharmony_ci goto err_ringrxfdq_free; 5958c2ecf20Sopenharmony_ci } 5968c2ecf20Sopenharmony_ci 5978c2ecf20Sopenharmony_ci if (rx_chn->remote) { 5988c2ecf20Sopenharmony_ci rx_ring_id = TI_SCI_RESOURCE_NULL; 5998c2ecf20Sopenharmony_ci rx_ringfdq_id = TI_SCI_RESOURCE_NULL; 6008c2ecf20Sopenharmony_ci } else { 6018c2ecf20Sopenharmony_ci rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx); 6028c2ecf20Sopenharmony_ci rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq); 6038c2ecf20Sopenharmony_ci } 6048c2ecf20Sopenharmony_ci 6058c2ecf20Sopenharmony_ci memset(&req, 0, sizeof(req)); 6068c2ecf20Sopenharmony_ci 6078c2ecf20Sopenharmony_ci req.valid_params = 6088c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_EINFO_PRESENT_VALID | 6098c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_PSINFO_PRESENT_VALID | 6108c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_ERROR_HANDLING_VALID | 6118c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DESC_TYPE_VALID | 6128c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID | 6138c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_HI_SEL_VALID | 6148c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_LO_SEL_VALID | 6158c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_HI_SEL_VALID | 6168c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_LO_SEL_VALID | 6178c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID | 6188c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID | 6198c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID | 6208c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID; 6218c2ecf20Sopenharmony_ci req.nav_id = tisci_rm->tisci_dev_id; 6228c2ecf20Sopenharmony_ci req.flow_index = flow->udma_rflow_id; 6238c2ecf20Sopenharmony_ci if (rx_chn->common.epib) 6248c2ecf20Sopenharmony_ci req.rx_einfo_present = 1; 6258c2ecf20Sopenharmony_ci if (rx_chn->common.psdata_size) 6268c2ecf20Sopenharmony_ci req.rx_psinfo_present = 1; 6278c2ecf20Sopenharmony_ci if (flow_cfg->rx_error_handling) 6288c2ecf20Sopenharmony_ci req.rx_error_handling = 1; 6298c2ecf20Sopenharmony_ci req.rx_desc_type = 0; 6308c2ecf20Sopenharmony_ci req.rx_dest_qnum = rx_ring_id; 6318c2ecf20Sopenharmony_ci req.rx_src_tag_hi_sel = 0; 6328c2ecf20Sopenharmony_ci req.rx_src_tag_lo_sel = flow_cfg->src_tag_lo_sel; 6338c2ecf20Sopenharmony_ci req.rx_dest_tag_hi_sel = 0; 6348c2ecf20Sopenharmony_ci req.rx_dest_tag_lo_sel = 0; 6358c2ecf20Sopenharmony_ci req.rx_fdq0_sz0_qnum = rx_ringfdq_id; 6368c2ecf20Sopenharmony_ci req.rx_fdq1_qnum = rx_ringfdq_id; 6378c2ecf20Sopenharmony_ci req.rx_fdq2_qnum = rx_ringfdq_id; 6388c2ecf20Sopenharmony_ci req.rx_fdq3_qnum = rx_ringfdq_id; 6398c2ecf20Sopenharmony_ci 6408c2ecf20Sopenharmony_ci ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req); 6418c2ecf20Sopenharmony_ci if (ret) { 6428c2ecf20Sopenharmony_ci dev_err(dev, "flow%d config failed: %d\n", flow->udma_rflow_id, 6438c2ecf20Sopenharmony_ci ret); 6448c2ecf20Sopenharmony_ci goto err_ringrxfdq_free; 6458c2ecf20Sopenharmony_ci } 6468c2ecf20Sopenharmony_ci 6478c2ecf20Sopenharmony_ci rx_chn->flows_ready++; 6488c2ecf20Sopenharmony_ci dev_dbg(dev, "flow%d config done. ready:%d\n", 6498c2ecf20Sopenharmony_ci flow->udma_rflow_id, rx_chn->flows_ready); 6508c2ecf20Sopenharmony_ci 6518c2ecf20Sopenharmony_ci return 0; 6528c2ecf20Sopenharmony_ci 6538c2ecf20Sopenharmony_cierr_ringrxfdq_free: 6548c2ecf20Sopenharmony_ci k3_ringacc_ring_free(flow->ringrxfdq); 6558c2ecf20Sopenharmony_ci k3_ringacc_ring_free(flow->ringrx); 6568c2ecf20Sopenharmony_ci 6578c2ecf20Sopenharmony_cierr_rflow_put: 6588c2ecf20Sopenharmony_ci xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow); 6598c2ecf20Sopenharmony_ci flow->udma_rflow = NULL; 6608c2ecf20Sopenharmony_ci 6618c2ecf20Sopenharmony_ci return ret; 6628c2ecf20Sopenharmony_ci} 6638c2ecf20Sopenharmony_ci 6648c2ecf20Sopenharmony_cistatic void k3_udma_glue_dump_rx_chn(struct k3_udma_glue_rx_channel *chn) 6658c2ecf20Sopenharmony_ci{ 6668c2ecf20Sopenharmony_ci struct device *dev = chn->common.dev; 6678c2ecf20Sopenharmony_ci 6688c2ecf20Sopenharmony_ci dev_dbg(dev, "dump_rx_chn:\n" 6698c2ecf20Sopenharmony_ci "udma_rchan_id: %d\n" 6708c2ecf20Sopenharmony_ci "src_thread: %08x\n" 6718c2ecf20Sopenharmony_ci "dst_thread: %08x\n" 6728c2ecf20Sopenharmony_ci "epib: %d\n" 6738c2ecf20Sopenharmony_ci "hdesc_size: %u\n" 6748c2ecf20Sopenharmony_ci "psdata_size: %u\n" 6758c2ecf20Sopenharmony_ci "swdata_size: %u\n" 6768c2ecf20Sopenharmony_ci "flow_id_base: %d\n" 6778c2ecf20Sopenharmony_ci "flow_num: %d\n", 6788c2ecf20Sopenharmony_ci chn->udma_rchan_id, 6798c2ecf20Sopenharmony_ci chn->common.src_thread, 6808c2ecf20Sopenharmony_ci chn->common.dst_thread, 6818c2ecf20Sopenharmony_ci chn->common.epib, 6828c2ecf20Sopenharmony_ci chn->common.hdesc_size, 6838c2ecf20Sopenharmony_ci chn->common.psdata_size, 6848c2ecf20Sopenharmony_ci chn->common.swdata_size, 6858c2ecf20Sopenharmony_ci chn->flow_id_base, 6868c2ecf20Sopenharmony_ci chn->flow_num); 6878c2ecf20Sopenharmony_ci} 6888c2ecf20Sopenharmony_ci 6898c2ecf20Sopenharmony_cistatic void k3_udma_glue_dump_rx_rt_chn(struct k3_udma_glue_rx_channel *chn, 6908c2ecf20Sopenharmony_ci char *mark) 6918c2ecf20Sopenharmony_ci{ 6928c2ecf20Sopenharmony_ci struct device *dev = chn->common.dev; 6938c2ecf20Sopenharmony_ci 6948c2ecf20Sopenharmony_ci dev_dbg(dev, "=== dump ===> %s\n", mark); 6958c2ecf20Sopenharmony_ci 6968c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG, 6978c2ecf20Sopenharmony_ci xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG)); 6988c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG, 6998c2ecf20Sopenharmony_ci xudma_rchanrt_read(chn->udma_rchanx, 7008c2ecf20Sopenharmony_ci UDMA_CHAN_RT_PEER_RT_EN_REG)); 7018c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG, 7028c2ecf20Sopenharmony_ci xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_PCNT_REG)); 7038c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG, 7048c2ecf20Sopenharmony_ci xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_BCNT_REG)); 7058c2ecf20Sopenharmony_ci dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG, 7068c2ecf20Sopenharmony_ci xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_SBCNT_REG)); 7078c2ecf20Sopenharmony_ci} 7088c2ecf20Sopenharmony_ci 7098c2ecf20Sopenharmony_cistatic int 7108c2ecf20Sopenharmony_cik3_udma_glue_allocate_rx_flows(struct k3_udma_glue_rx_channel *rx_chn, 7118c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_channel_cfg *cfg) 7128c2ecf20Sopenharmony_ci{ 7138c2ecf20Sopenharmony_ci int ret; 7148c2ecf20Sopenharmony_ci 7158c2ecf20Sopenharmony_ci /* default rflow */ 7168c2ecf20Sopenharmony_ci if (cfg->flow_id_use_rxchan_id) 7178c2ecf20Sopenharmony_ci return 0; 7188c2ecf20Sopenharmony_ci 7198c2ecf20Sopenharmony_ci /* not a GP rflows */ 7208c2ecf20Sopenharmony_ci if (rx_chn->flow_id_base != -1 && 7218c2ecf20Sopenharmony_ci !xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base)) 7228c2ecf20Sopenharmony_ci return 0; 7238c2ecf20Sopenharmony_ci 7248c2ecf20Sopenharmony_ci /* Allocate range of GP rflows */ 7258c2ecf20Sopenharmony_ci ret = xudma_alloc_gp_rflow_range(rx_chn->common.udmax, 7268c2ecf20Sopenharmony_ci rx_chn->flow_id_base, 7278c2ecf20Sopenharmony_ci rx_chn->flow_num); 7288c2ecf20Sopenharmony_ci if (ret < 0) { 7298c2ecf20Sopenharmony_ci dev_err(rx_chn->common.dev, "UDMAX reserve_rflow %d cnt:%d err: %d\n", 7308c2ecf20Sopenharmony_ci rx_chn->flow_id_base, rx_chn->flow_num, ret); 7318c2ecf20Sopenharmony_ci return ret; 7328c2ecf20Sopenharmony_ci } 7338c2ecf20Sopenharmony_ci rx_chn->flow_id_base = ret; 7348c2ecf20Sopenharmony_ci 7358c2ecf20Sopenharmony_ci return 0; 7368c2ecf20Sopenharmony_ci} 7378c2ecf20Sopenharmony_ci 7388c2ecf20Sopenharmony_cistatic struct k3_udma_glue_rx_channel * 7398c2ecf20Sopenharmony_cik3_udma_glue_request_rx_chn_priv(struct device *dev, const char *name, 7408c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_channel_cfg *cfg) 7418c2ecf20Sopenharmony_ci{ 7428c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_channel *rx_chn; 7438c2ecf20Sopenharmony_ci int ret, i; 7448c2ecf20Sopenharmony_ci 7458c2ecf20Sopenharmony_ci if (cfg->flow_id_num <= 0) 7468c2ecf20Sopenharmony_ci return ERR_PTR(-EINVAL); 7478c2ecf20Sopenharmony_ci 7488c2ecf20Sopenharmony_ci if (cfg->flow_id_num != 1 && 7498c2ecf20Sopenharmony_ci (cfg->def_flow_cfg || cfg->flow_id_use_rxchan_id)) 7508c2ecf20Sopenharmony_ci return ERR_PTR(-EINVAL); 7518c2ecf20Sopenharmony_ci 7528c2ecf20Sopenharmony_ci rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL); 7538c2ecf20Sopenharmony_ci if (!rx_chn) 7548c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 7558c2ecf20Sopenharmony_ci 7568c2ecf20Sopenharmony_ci rx_chn->common.dev = dev; 7578c2ecf20Sopenharmony_ci rx_chn->common.swdata_size = cfg->swdata_size; 7588c2ecf20Sopenharmony_ci rx_chn->remote = false; 7598c2ecf20Sopenharmony_ci 7608c2ecf20Sopenharmony_ci /* parse of udmap channel */ 7618c2ecf20Sopenharmony_ci ret = of_k3_udma_glue_parse_chn(dev->of_node, name, 7628c2ecf20Sopenharmony_ci &rx_chn->common, false); 7638c2ecf20Sopenharmony_ci if (ret) 7648c2ecf20Sopenharmony_ci goto err; 7658c2ecf20Sopenharmony_ci 7668c2ecf20Sopenharmony_ci rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib, 7678c2ecf20Sopenharmony_ci rx_chn->common.psdata_size, 7688c2ecf20Sopenharmony_ci rx_chn->common.swdata_size); 7698c2ecf20Sopenharmony_ci 7708c2ecf20Sopenharmony_ci /* request and cfg UDMAP RX channel */ 7718c2ecf20Sopenharmony_ci rx_chn->udma_rchanx = xudma_rchan_get(rx_chn->common.udmax, -1); 7728c2ecf20Sopenharmony_ci if (IS_ERR(rx_chn->udma_rchanx)) { 7738c2ecf20Sopenharmony_ci ret = PTR_ERR(rx_chn->udma_rchanx); 7748c2ecf20Sopenharmony_ci dev_err(dev, "UDMAX rchanx get err %d\n", ret); 7758c2ecf20Sopenharmony_ci goto err; 7768c2ecf20Sopenharmony_ci } 7778c2ecf20Sopenharmony_ci rx_chn->udma_rchan_id = xudma_rchan_get_id(rx_chn->udma_rchanx); 7788c2ecf20Sopenharmony_ci 7798c2ecf20Sopenharmony_ci rx_chn->flow_num = cfg->flow_id_num; 7808c2ecf20Sopenharmony_ci rx_chn->flow_id_base = cfg->flow_id_base; 7818c2ecf20Sopenharmony_ci 7828c2ecf20Sopenharmony_ci /* Use RX channel id as flow id: target dev can't generate flow_id */ 7838c2ecf20Sopenharmony_ci if (cfg->flow_id_use_rxchan_id) 7848c2ecf20Sopenharmony_ci rx_chn->flow_id_base = rx_chn->udma_rchan_id; 7858c2ecf20Sopenharmony_ci 7868c2ecf20Sopenharmony_ci rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num, 7878c2ecf20Sopenharmony_ci sizeof(*rx_chn->flows), GFP_KERNEL); 7888c2ecf20Sopenharmony_ci if (!rx_chn->flows) { 7898c2ecf20Sopenharmony_ci ret = -ENOMEM; 7908c2ecf20Sopenharmony_ci goto err; 7918c2ecf20Sopenharmony_ci } 7928c2ecf20Sopenharmony_ci 7938c2ecf20Sopenharmony_ci ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg); 7948c2ecf20Sopenharmony_ci if (ret) 7958c2ecf20Sopenharmony_ci goto err; 7968c2ecf20Sopenharmony_ci 7978c2ecf20Sopenharmony_ci for (i = 0; i < rx_chn->flow_num; i++) 7988c2ecf20Sopenharmony_ci rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i; 7998c2ecf20Sopenharmony_ci 8008c2ecf20Sopenharmony_ci /* request and cfg psi-l */ 8018c2ecf20Sopenharmony_ci rx_chn->common.dst_thread = 8028c2ecf20Sopenharmony_ci xudma_dev_get_psil_base(rx_chn->common.udmax) + 8038c2ecf20Sopenharmony_ci rx_chn->udma_rchan_id; 8048c2ecf20Sopenharmony_ci 8058c2ecf20Sopenharmony_ci ret = k3_udma_glue_cfg_rx_chn(rx_chn); 8068c2ecf20Sopenharmony_ci if (ret) { 8078c2ecf20Sopenharmony_ci dev_err(dev, "Failed to cfg rchan %d\n", ret); 8088c2ecf20Sopenharmony_ci goto err; 8098c2ecf20Sopenharmony_ci } 8108c2ecf20Sopenharmony_ci 8118c2ecf20Sopenharmony_ci /* init default RX flow only if flow_num = 1 */ 8128c2ecf20Sopenharmony_ci if (cfg->def_flow_cfg) { 8138c2ecf20Sopenharmony_ci ret = k3_udma_glue_cfg_rx_flow(rx_chn, 0, cfg->def_flow_cfg); 8148c2ecf20Sopenharmony_ci if (ret) 8158c2ecf20Sopenharmony_ci goto err; 8168c2ecf20Sopenharmony_ci } 8178c2ecf20Sopenharmony_ci 8188c2ecf20Sopenharmony_ci ret = xudma_navss_psil_pair(rx_chn->common.udmax, 8198c2ecf20Sopenharmony_ci rx_chn->common.src_thread, 8208c2ecf20Sopenharmony_ci rx_chn->common.dst_thread); 8218c2ecf20Sopenharmony_ci if (ret) { 8228c2ecf20Sopenharmony_ci dev_err(dev, "PSI-L request err %d\n", ret); 8238c2ecf20Sopenharmony_ci goto err; 8248c2ecf20Sopenharmony_ci } 8258c2ecf20Sopenharmony_ci 8268c2ecf20Sopenharmony_ci rx_chn->psil_paired = true; 8278c2ecf20Sopenharmony_ci 8288c2ecf20Sopenharmony_ci /* reset RX RT registers */ 8298c2ecf20Sopenharmony_ci k3_udma_glue_disable_rx_chn(rx_chn); 8308c2ecf20Sopenharmony_ci 8318c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_chn(rx_chn); 8328c2ecf20Sopenharmony_ci 8338c2ecf20Sopenharmony_ci return rx_chn; 8348c2ecf20Sopenharmony_ci 8358c2ecf20Sopenharmony_cierr: 8368c2ecf20Sopenharmony_ci k3_udma_glue_release_rx_chn(rx_chn); 8378c2ecf20Sopenharmony_ci return ERR_PTR(ret); 8388c2ecf20Sopenharmony_ci} 8398c2ecf20Sopenharmony_ci 8408c2ecf20Sopenharmony_cistatic struct k3_udma_glue_rx_channel * 8418c2ecf20Sopenharmony_cik3_udma_glue_request_remote_rx_chn(struct device *dev, const char *name, 8428c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_channel_cfg *cfg) 8438c2ecf20Sopenharmony_ci{ 8448c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_channel *rx_chn; 8458c2ecf20Sopenharmony_ci int ret, i; 8468c2ecf20Sopenharmony_ci 8478c2ecf20Sopenharmony_ci if (cfg->flow_id_num <= 0 || 8488c2ecf20Sopenharmony_ci cfg->flow_id_use_rxchan_id || 8498c2ecf20Sopenharmony_ci cfg->def_flow_cfg || 8508c2ecf20Sopenharmony_ci cfg->flow_id_base < 0) 8518c2ecf20Sopenharmony_ci return ERR_PTR(-EINVAL); 8528c2ecf20Sopenharmony_ci 8538c2ecf20Sopenharmony_ci /* 8548c2ecf20Sopenharmony_ci * Remote RX channel is under control of Remote CPU core, so 8558c2ecf20Sopenharmony_ci * Linux can only request and manipulate by dedicated RX flows 8568c2ecf20Sopenharmony_ci */ 8578c2ecf20Sopenharmony_ci 8588c2ecf20Sopenharmony_ci rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL); 8598c2ecf20Sopenharmony_ci if (!rx_chn) 8608c2ecf20Sopenharmony_ci return ERR_PTR(-ENOMEM); 8618c2ecf20Sopenharmony_ci 8628c2ecf20Sopenharmony_ci rx_chn->common.dev = dev; 8638c2ecf20Sopenharmony_ci rx_chn->common.swdata_size = cfg->swdata_size; 8648c2ecf20Sopenharmony_ci rx_chn->remote = true; 8658c2ecf20Sopenharmony_ci rx_chn->udma_rchan_id = -1; 8668c2ecf20Sopenharmony_ci rx_chn->flow_num = cfg->flow_id_num; 8678c2ecf20Sopenharmony_ci rx_chn->flow_id_base = cfg->flow_id_base; 8688c2ecf20Sopenharmony_ci rx_chn->psil_paired = false; 8698c2ecf20Sopenharmony_ci 8708c2ecf20Sopenharmony_ci /* parse of udmap channel */ 8718c2ecf20Sopenharmony_ci ret = of_k3_udma_glue_parse_chn(dev->of_node, name, 8728c2ecf20Sopenharmony_ci &rx_chn->common, false); 8738c2ecf20Sopenharmony_ci if (ret) 8748c2ecf20Sopenharmony_ci goto err; 8758c2ecf20Sopenharmony_ci 8768c2ecf20Sopenharmony_ci rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib, 8778c2ecf20Sopenharmony_ci rx_chn->common.psdata_size, 8788c2ecf20Sopenharmony_ci rx_chn->common.swdata_size); 8798c2ecf20Sopenharmony_ci 8808c2ecf20Sopenharmony_ci rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num, 8818c2ecf20Sopenharmony_ci sizeof(*rx_chn->flows), GFP_KERNEL); 8828c2ecf20Sopenharmony_ci if (!rx_chn->flows) { 8838c2ecf20Sopenharmony_ci ret = -ENOMEM; 8848c2ecf20Sopenharmony_ci goto err; 8858c2ecf20Sopenharmony_ci } 8868c2ecf20Sopenharmony_ci 8878c2ecf20Sopenharmony_ci ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg); 8888c2ecf20Sopenharmony_ci if (ret) 8898c2ecf20Sopenharmony_ci goto err; 8908c2ecf20Sopenharmony_ci 8918c2ecf20Sopenharmony_ci for (i = 0; i < rx_chn->flow_num; i++) 8928c2ecf20Sopenharmony_ci rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i; 8938c2ecf20Sopenharmony_ci 8948c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_chn(rx_chn); 8958c2ecf20Sopenharmony_ci 8968c2ecf20Sopenharmony_ci return rx_chn; 8978c2ecf20Sopenharmony_ci 8988c2ecf20Sopenharmony_cierr: 8998c2ecf20Sopenharmony_ci k3_udma_glue_release_rx_chn(rx_chn); 9008c2ecf20Sopenharmony_ci return ERR_PTR(ret); 9018c2ecf20Sopenharmony_ci} 9028c2ecf20Sopenharmony_ci 9038c2ecf20Sopenharmony_cistruct k3_udma_glue_rx_channel * 9048c2ecf20Sopenharmony_cik3_udma_glue_request_rx_chn(struct device *dev, const char *name, 9058c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_channel_cfg *cfg) 9068c2ecf20Sopenharmony_ci{ 9078c2ecf20Sopenharmony_ci if (cfg->remote) 9088c2ecf20Sopenharmony_ci return k3_udma_glue_request_remote_rx_chn(dev, name, cfg); 9098c2ecf20Sopenharmony_ci else 9108c2ecf20Sopenharmony_ci return k3_udma_glue_request_rx_chn_priv(dev, name, cfg); 9118c2ecf20Sopenharmony_ci} 9128c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_request_rx_chn); 9138c2ecf20Sopenharmony_ci 9148c2ecf20Sopenharmony_civoid k3_udma_glue_release_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 9158c2ecf20Sopenharmony_ci{ 9168c2ecf20Sopenharmony_ci int i; 9178c2ecf20Sopenharmony_ci 9188c2ecf20Sopenharmony_ci if (IS_ERR_OR_NULL(rx_chn->common.udmax)) 9198c2ecf20Sopenharmony_ci return; 9208c2ecf20Sopenharmony_ci 9218c2ecf20Sopenharmony_ci if (rx_chn->psil_paired) { 9228c2ecf20Sopenharmony_ci xudma_navss_psil_unpair(rx_chn->common.udmax, 9238c2ecf20Sopenharmony_ci rx_chn->common.src_thread, 9248c2ecf20Sopenharmony_ci rx_chn->common.dst_thread); 9258c2ecf20Sopenharmony_ci rx_chn->psil_paired = false; 9268c2ecf20Sopenharmony_ci } 9278c2ecf20Sopenharmony_ci 9288c2ecf20Sopenharmony_ci for (i = 0; i < rx_chn->flow_num; i++) 9298c2ecf20Sopenharmony_ci k3_udma_glue_release_rx_flow(rx_chn, i); 9308c2ecf20Sopenharmony_ci 9318c2ecf20Sopenharmony_ci if (xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base)) 9328c2ecf20Sopenharmony_ci xudma_free_gp_rflow_range(rx_chn->common.udmax, 9338c2ecf20Sopenharmony_ci rx_chn->flow_id_base, 9348c2ecf20Sopenharmony_ci rx_chn->flow_num); 9358c2ecf20Sopenharmony_ci 9368c2ecf20Sopenharmony_ci if (!IS_ERR_OR_NULL(rx_chn->udma_rchanx)) 9378c2ecf20Sopenharmony_ci xudma_rchan_put(rx_chn->common.udmax, 9388c2ecf20Sopenharmony_ci rx_chn->udma_rchanx); 9398c2ecf20Sopenharmony_ci} 9408c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_release_rx_chn); 9418c2ecf20Sopenharmony_ci 9428c2ecf20Sopenharmony_ciint k3_udma_glue_rx_flow_init(struct k3_udma_glue_rx_channel *rx_chn, 9438c2ecf20Sopenharmony_ci u32 flow_idx, 9448c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow_cfg *flow_cfg) 9458c2ecf20Sopenharmony_ci{ 9468c2ecf20Sopenharmony_ci if (flow_idx >= rx_chn->flow_num) 9478c2ecf20Sopenharmony_ci return -EINVAL; 9488c2ecf20Sopenharmony_ci 9498c2ecf20Sopenharmony_ci return k3_udma_glue_cfg_rx_flow(rx_chn, flow_idx, flow_cfg); 9508c2ecf20Sopenharmony_ci} 9518c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_init); 9528c2ecf20Sopenharmony_ci 9538c2ecf20Sopenharmony_ciu32 k3_udma_glue_rx_flow_get_fdq_id(struct k3_udma_glue_rx_channel *rx_chn, 9548c2ecf20Sopenharmony_ci u32 flow_idx) 9558c2ecf20Sopenharmony_ci{ 9568c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow; 9578c2ecf20Sopenharmony_ci 9588c2ecf20Sopenharmony_ci if (flow_idx >= rx_chn->flow_num) 9598c2ecf20Sopenharmony_ci return -EINVAL; 9608c2ecf20Sopenharmony_ci 9618c2ecf20Sopenharmony_ci flow = &rx_chn->flows[flow_idx]; 9628c2ecf20Sopenharmony_ci 9638c2ecf20Sopenharmony_ci return k3_ringacc_get_ring_id(flow->ringrxfdq); 9648c2ecf20Sopenharmony_ci} 9658c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_get_fdq_id); 9668c2ecf20Sopenharmony_ci 9678c2ecf20Sopenharmony_ciu32 k3_udma_glue_rx_get_flow_id_base(struct k3_udma_glue_rx_channel *rx_chn) 9688c2ecf20Sopenharmony_ci{ 9698c2ecf20Sopenharmony_ci return rx_chn->flow_id_base; 9708c2ecf20Sopenharmony_ci} 9718c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_flow_id_base); 9728c2ecf20Sopenharmony_ci 9738c2ecf20Sopenharmony_ciint k3_udma_glue_rx_flow_enable(struct k3_udma_glue_rx_channel *rx_chn, 9748c2ecf20Sopenharmony_ci u32 flow_idx) 9758c2ecf20Sopenharmony_ci{ 9768c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx]; 9778c2ecf20Sopenharmony_ci const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 9788c2ecf20Sopenharmony_ci struct device *dev = rx_chn->common.dev; 9798c2ecf20Sopenharmony_ci struct ti_sci_msg_rm_udmap_flow_cfg req; 9808c2ecf20Sopenharmony_ci int rx_ring_id; 9818c2ecf20Sopenharmony_ci int rx_ringfdq_id; 9828c2ecf20Sopenharmony_ci int ret = 0; 9838c2ecf20Sopenharmony_ci 9848c2ecf20Sopenharmony_ci if (!rx_chn->remote) 9858c2ecf20Sopenharmony_ci return -EINVAL; 9868c2ecf20Sopenharmony_ci 9878c2ecf20Sopenharmony_ci rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx); 9888c2ecf20Sopenharmony_ci rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq); 9898c2ecf20Sopenharmony_ci 9908c2ecf20Sopenharmony_ci memset(&req, 0, sizeof(req)); 9918c2ecf20Sopenharmony_ci 9928c2ecf20Sopenharmony_ci req.valid_params = 9938c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID | 9948c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID | 9958c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID | 9968c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID | 9978c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID; 9988c2ecf20Sopenharmony_ci req.nav_id = tisci_rm->tisci_dev_id; 9998c2ecf20Sopenharmony_ci req.flow_index = flow->udma_rflow_id; 10008c2ecf20Sopenharmony_ci req.rx_dest_qnum = rx_ring_id; 10018c2ecf20Sopenharmony_ci req.rx_fdq0_sz0_qnum = rx_ringfdq_id; 10028c2ecf20Sopenharmony_ci req.rx_fdq1_qnum = rx_ringfdq_id; 10038c2ecf20Sopenharmony_ci req.rx_fdq2_qnum = rx_ringfdq_id; 10048c2ecf20Sopenharmony_ci req.rx_fdq3_qnum = rx_ringfdq_id; 10058c2ecf20Sopenharmony_ci 10068c2ecf20Sopenharmony_ci ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req); 10078c2ecf20Sopenharmony_ci if (ret) { 10088c2ecf20Sopenharmony_ci dev_err(dev, "flow%d enable failed: %d\n", flow->udma_rflow_id, 10098c2ecf20Sopenharmony_ci ret); 10108c2ecf20Sopenharmony_ci } 10118c2ecf20Sopenharmony_ci 10128c2ecf20Sopenharmony_ci return ret; 10138c2ecf20Sopenharmony_ci} 10148c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_enable); 10158c2ecf20Sopenharmony_ci 10168c2ecf20Sopenharmony_ciint k3_udma_glue_rx_flow_disable(struct k3_udma_glue_rx_channel *rx_chn, 10178c2ecf20Sopenharmony_ci u32 flow_idx) 10188c2ecf20Sopenharmony_ci{ 10198c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx]; 10208c2ecf20Sopenharmony_ci const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 10218c2ecf20Sopenharmony_ci struct device *dev = rx_chn->common.dev; 10228c2ecf20Sopenharmony_ci struct ti_sci_msg_rm_udmap_flow_cfg req; 10238c2ecf20Sopenharmony_ci int ret = 0; 10248c2ecf20Sopenharmony_ci 10258c2ecf20Sopenharmony_ci if (!rx_chn->remote) 10268c2ecf20Sopenharmony_ci return -EINVAL; 10278c2ecf20Sopenharmony_ci 10288c2ecf20Sopenharmony_ci memset(&req, 0, sizeof(req)); 10298c2ecf20Sopenharmony_ci req.valid_params = 10308c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID | 10318c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID | 10328c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID | 10338c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID | 10348c2ecf20Sopenharmony_ci TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID; 10358c2ecf20Sopenharmony_ci req.nav_id = tisci_rm->tisci_dev_id; 10368c2ecf20Sopenharmony_ci req.flow_index = flow->udma_rflow_id; 10378c2ecf20Sopenharmony_ci req.rx_dest_qnum = TI_SCI_RESOURCE_NULL; 10388c2ecf20Sopenharmony_ci req.rx_fdq0_sz0_qnum = TI_SCI_RESOURCE_NULL; 10398c2ecf20Sopenharmony_ci req.rx_fdq1_qnum = TI_SCI_RESOURCE_NULL; 10408c2ecf20Sopenharmony_ci req.rx_fdq2_qnum = TI_SCI_RESOURCE_NULL; 10418c2ecf20Sopenharmony_ci req.rx_fdq3_qnum = TI_SCI_RESOURCE_NULL; 10428c2ecf20Sopenharmony_ci 10438c2ecf20Sopenharmony_ci ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req); 10448c2ecf20Sopenharmony_ci if (ret) { 10458c2ecf20Sopenharmony_ci dev_err(dev, "flow%d disable failed: %d\n", flow->udma_rflow_id, 10468c2ecf20Sopenharmony_ci ret); 10478c2ecf20Sopenharmony_ci } 10488c2ecf20Sopenharmony_ci 10498c2ecf20Sopenharmony_ci return ret; 10508c2ecf20Sopenharmony_ci} 10518c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_disable); 10528c2ecf20Sopenharmony_ci 10538c2ecf20Sopenharmony_ciint k3_udma_glue_enable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 10548c2ecf20Sopenharmony_ci{ 10558c2ecf20Sopenharmony_ci if (rx_chn->remote) 10568c2ecf20Sopenharmony_ci return -EINVAL; 10578c2ecf20Sopenharmony_ci 10588c2ecf20Sopenharmony_ci if (rx_chn->flows_ready < rx_chn->flow_num) 10598c2ecf20Sopenharmony_ci return -EINVAL; 10608c2ecf20Sopenharmony_ci 10618c2ecf20Sopenharmony_ci xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG, 10628c2ecf20Sopenharmony_ci UDMA_CHAN_RT_CTL_EN); 10638c2ecf20Sopenharmony_ci 10648c2ecf20Sopenharmony_ci xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG, 10658c2ecf20Sopenharmony_ci UDMA_PEER_RT_EN_ENABLE); 10668c2ecf20Sopenharmony_ci 10678c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt en"); 10688c2ecf20Sopenharmony_ci return 0; 10698c2ecf20Sopenharmony_ci} 10708c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_enable_rx_chn); 10718c2ecf20Sopenharmony_ci 10728c2ecf20Sopenharmony_civoid k3_udma_glue_disable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 10738c2ecf20Sopenharmony_ci{ 10748c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis1"); 10758c2ecf20Sopenharmony_ci 10768c2ecf20Sopenharmony_ci xudma_rchanrt_write(rx_chn->udma_rchanx, 10778c2ecf20Sopenharmony_ci UDMA_CHAN_RT_PEER_RT_EN_REG, 0); 10788c2ecf20Sopenharmony_ci xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG, 0); 10798c2ecf20Sopenharmony_ci 10808c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis2"); 10818c2ecf20Sopenharmony_ci} 10828c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_disable_rx_chn); 10838c2ecf20Sopenharmony_ci 10848c2ecf20Sopenharmony_civoid k3_udma_glue_tdown_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 10858c2ecf20Sopenharmony_ci bool sync) 10868c2ecf20Sopenharmony_ci{ 10878c2ecf20Sopenharmony_ci int i = 0; 10888c2ecf20Sopenharmony_ci u32 val; 10898c2ecf20Sopenharmony_ci 10908c2ecf20Sopenharmony_ci if (rx_chn->remote) 10918c2ecf20Sopenharmony_ci return; 10928c2ecf20Sopenharmony_ci 10938c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown1"); 10948c2ecf20Sopenharmony_ci 10958c2ecf20Sopenharmony_ci xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG, 10968c2ecf20Sopenharmony_ci UDMA_PEER_RT_EN_ENABLE | UDMA_PEER_RT_EN_TEARDOWN); 10978c2ecf20Sopenharmony_ci 10988c2ecf20Sopenharmony_ci val = xudma_rchanrt_read(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG); 10998c2ecf20Sopenharmony_ci 11008c2ecf20Sopenharmony_ci while (sync && (val & UDMA_CHAN_RT_CTL_EN)) { 11018c2ecf20Sopenharmony_ci val = xudma_rchanrt_read(rx_chn->udma_rchanx, 11028c2ecf20Sopenharmony_ci UDMA_CHAN_RT_CTL_REG); 11038c2ecf20Sopenharmony_ci udelay(1); 11048c2ecf20Sopenharmony_ci if (i > K3_UDMAX_TDOWN_TIMEOUT_US) { 11058c2ecf20Sopenharmony_ci dev_err(rx_chn->common.dev, "RX tdown timeout\n"); 11068c2ecf20Sopenharmony_ci break; 11078c2ecf20Sopenharmony_ci } 11088c2ecf20Sopenharmony_ci i++; 11098c2ecf20Sopenharmony_ci } 11108c2ecf20Sopenharmony_ci 11118c2ecf20Sopenharmony_ci val = xudma_rchanrt_read(rx_chn->udma_rchanx, 11128c2ecf20Sopenharmony_ci UDMA_CHAN_RT_PEER_RT_EN_REG); 11138c2ecf20Sopenharmony_ci if (sync && (val & UDMA_PEER_RT_EN_ENABLE)) 11148c2ecf20Sopenharmony_ci dev_err(rx_chn->common.dev, "TX tdown peer not stopped\n"); 11158c2ecf20Sopenharmony_ci k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown2"); 11168c2ecf20Sopenharmony_ci} 11178c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_tdown_rx_chn); 11188c2ecf20Sopenharmony_ci 11198c2ecf20Sopenharmony_civoid k3_udma_glue_reset_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 11208c2ecf20Sopenharmony_ci u32 flow_num, void *data, 11218c2ecf20Sopenharmony_ci void (*cleanup)(void *data, dma_addr_t desc_dma), bool skip_fdq) 11228c2ecf20Sopenharmony_ci{ 11238c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 11248c2ecf20Sopenharmony_ci struct device *dev = rx_chn->common.dev; 11258c2ecf20Sopenharmony_ci dma_addr_t desc_dma; 11268c2ecf20Sopenharmony_ci int occ_rx, i, ret; 11278c2ecf20Sopenharmony_ci 11288c2ecf20Sopenharmony_ci /* reset RXCQ as it is not input for udma - expected to be empty */ 11298c2ecf20Sopenharmony_ci occ_rx = k3_ringacc_ring_get_occ(flow->ringrx); 11308c2ecf20Sopenharmony_ci dev_dbg(dev, "RX reset flow %u occ_rx %u\n", flow_num, occ_rx); 11318c2ecf20Sopenharmony_ci if (flow->ringrx) 11328c2ecf20Sopenharmony_ci k3_ringacc_ring_reset(flow->ringrx); 11338c2ecf20Sopenharmony_ci 11348c2ecf20Sopenharmony_ci /* Skip RX FDQ in case one FDQ is used for the set of flows */ 11358c2ecf20Sopenharmony_ci if (skip_fdq) 11368c2ecf20Sopenharmony_ci return; 11378c2ecf20Sopenharmony_ci 11388c2ecf20Sopenharmony_ci /* 11398c2ecf20Sopenharmony_ci * RX FDQ reset need to be special way as it is input for udma and its 11408c2ecf20Sopenharmony_ci * state cached by udma, so: 11418c2ecf20Sopenharmony_ci * 1) save RX FDQ occ 11428c2ecf20Sopenharmony_ci * 2) clean up RX FDQ and call callback .cleanup() for each desc 11438c2ecf20Sopenharmony_ci * 3) reset RX FDQ in a special way 11448c2ecf20Sopenharmony_ci */ 11458c2ecf20Sopenharmony_ci occ_rx = k3_ringacc_ring_get_occ(flow->ringrxfdq); 11468c2ecf20Sopenharmony_ci dev_dbg(dev, "RX reset flow %u occ_rx_fdq %u\n", flow_num, occ_rx); 11478c2ecf20Sopenharmony_ci 11488c2ecf20Sopenharmony_ci for (i = 0; i < occ_rx; i++) { 11498c2ecf20Sopenharmony_ci ret = k3_ringacc_ring_pop(flow->ringrxfdq, &desc_dma); 11508c2ecf20Sopenharmony_ci if (ret) { 11518c2ecf20Sopenharmony_ci dev_err(dev, "RX reset pop %d\n", ret); 11528c2ecf20Sopenharmony_ci break; 11538c2ecf20Sopenharmony_ci } 11548c2ecf20Sopenharmony_ci cleanup(data, desc_dma); 11558c2ecf20Sopenharmony_ci } 11568c2ecf20Sopenharmony_ci 11578c2ecf20Sopenharmony_ci k3_ringacc_ring_reset_dma(flow->ringrxfdq, occ_rx); 11588c2ecf20Sopenharmony_ci} 11598c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_reset_rx_chn); 11608c2ecf20Sopenharmony_ci 11618c2ecf20Sopenharmony_ciint k3_udma_glue_push_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 11628c2ecf20Sopenharmony_ci u32 flow_num, struct cppi5_host_desc_t *desc_rx, 11638c2ecf20Sopenharmony_ci dma_addr_t desc_dma) 11648c2ecf20Sopenharmony_ci{ 11658c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 11668c2ecf20Sopenharmony_ci 11678c2ecf20Sopenharmony_ci return k3_ringacc_ring_push(flow->ringrxfdq, &desc_dma); 11688c2ecf20Sopenharmony_ci} 11698c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_push_rx_chn); 11708c2ecf20Sopenharmony_ci 11718c2ecf20Sopenharmony_ciint k3_udma_glue_pop_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 11728c2ecf20Sopenharmony_ci u32 flow_num, dma_addr_t *desc_dma) 11738c2ecf20Sopenharmony_ci{ 11748c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 11758c2ecf20Sopenharmony_ci 11768c2ecf20Sopenharmony_ci return k3_ringacc_ring_pop(flow->ringrx, desc_dma); 11778c2ecf20Sopenharmony_ci} 11788c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_pop_rx_chn); 11798c2ecf20Sopenharmony_ci 11808c2ecf20Sopenharmony_ciint k3_udma_glue_rx_get_irq(struct k3_udma_glue_rx_channel *rx_chn, 11818c2ecf20Sopenharmony_ci u32 flow_num) 11828c2ecf20Sopenharmony_ci{ 11838c2ecf20Sopenharmony_ci struct k3_udma_glue_rx_flow *flow; 11848c2ecf20Sopenharmony_ci 11858c2ecf20Sopenharmony_ci flow = &rx_chn->flows[flow_num]; 11868c2ecf20Sopenharmony_ci 11878c2ecf20Sopenharmony_ci flow->virq = k3_ringacc_get_ring_irq_num(flow->ringrx); 11888c2ecf20Sopenharmony_ci 11898c2ecf20Sopenharmony_ci return flow->virq; 11908c2ecf20Sopenharmony_ci} 11918c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_irq); 1192