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; 255b65781dSVignesh Raghavendra struct device chan_dev; 26d7024191SGrygorii Strashko struct udma_dev *udmax; 27d7024191SGrygorii Strashko const struct udma_tisci_rm *tisci_rm; 28d7024191SGrygorii Strashko struct k3_ringacc *ringacc; 29d7024191SGrygorii Strashko u32 src_thread; 30d7024191SGrygorii Strashko u32 dst_thread; 31d7024191SGrygorii Strashko 32d7024191SGrygorii Strashko u32 hdesc_size; 33d7024191SGrygorii Strashko bool epib; 34d7024191SGrygorii Strashko u32 psdata_size; 35d7024191SGrygorii Strashko u32 swdata_size; 365b65781dSVignesh Raghavendra u32 atype_asel; 375b65781dSVignesh Raghavendra struct psil_endpoint_config *ep_config; 38d7024191SGrygorii Strashko }; 39d7024191SGrygorii Strashko 40d7024191SGrygorii Strashko struct k3_udma_glue_tx_channel { 41d7024191SGrygorii Strashko struct k3_udma_glue_common common; 42d7024191SGrygorii Strashko 43d7024191SGrygorii Strashko struct udma_tchan *udma_tchanx; 44d7024191SGrygorii Strashko int udma_tchan_id; 45d7024191SGrygorii Strashko 46d7024191SGrygorii Strashko struct k3_ring *ringtx; 47d7024191SGrygorii Strashko struct k3_ring *ringtxcq; 48d7024191SGrygorii Strashko 49d7024191SGrygorii Strashko bool psil_paired; 50d7024191SGrygorii Strashko 51d7024191SGrygorii Strashko int virq; 52d7024191SGrygorii Strashko 53d7024191SGrygorii Strashko atomic_t free_pkts; 54d7024191SGrygorii Strashko bool tx_pause_on_err; 55d7024191SGrygorii Strashko bool tx_filt_einfo; 56d7024191SGrygorii Strashko bool tx_filt_pswords; 57d7024191SGrygorii Strashko bool tx_supr_tdpkt; 585b65781dSVignesh Raghavendra 595b65781dSVignesh Raghavendra int udma_tflow_id; 60d7024191SGrygorii Strashko }; 61d7024191SGrygorii Strashko 62d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow { 63d7024191SGrygorii Strashko struct udma_rflow *udma_rflow; 64d7024191SGrygorii Strashko int udma_rflow_id; 65d7024191SGrygorii Strashko struct k3_ring *ringrx; 66d7024191SGrygorii Strashko struct k3_ring *ringrxfdq; 67d7024191SGrygorii Strashko 68d7024191SGrygorii Strashko int virq; 69d7024191SGrygorii Strashko }; 70d7024191SGrygorii Strashko 71d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel { 72d7024191SGrygorii Strashko struct k3_udma_glue_common common; 73d7024191SGrygorii Strashko 74d7024191SGrygorii Strashko struct udma_rchan *udma_rchanx; 75d7024191SGrygorii Strashko int udma_rchan_id; 76d7024191SGrygorii Strashko bool remote; 77d7024191SGrygorii Strashko 78d7024191SGrygorii Strashko bool psil_paired; 79d7024191SGrygorii Strashko 80d7024191SGrygorii Strashko u32 swdata_size; 81d7024191SGrygorii Strashko int flow_id_base; 82d7024191SGrygorii Strashko 83d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flows; 84d7024191SGrygorii Strashko u32 flow_num; 85d7024191SGrygorii Strashko u32 flows_ready; 86d7024191SGrygorii Strashko }; 87d7024191SGrygorii Strashko 885b65781dSVignesh Raghavendra static void k3_udma_chan_dev_release(struct device *dev) 895b65781dSVignesh Raghavendra { 905b65781dSVignesh Raghavendra /* The struct containing the device is devm managed */ 915b65781dSVignesh Raghavendra } 925b65781dSVignesh Raghavendra 935b65781dSVignesh Raghavendra static struct class k3_udma_glue_devclass = { 945b65781dSVignesh Raghavendra .name = "k3_udma_glue_chan", 955b65781dSVignesh Raghavendra .dev_release = k3_udma_chan_dev_release, 965b65781dSVignesh Raghavendra }; 975b65781dSVignesh Raghavendra 98d7024191SGrygorii Strashko #define K3_UDMAX_TDOWN_TIMEOUT_US 1000 99d7024191SGrygorii Strashko 100d7024191SGrygorii Strashko static int of_k3_udma_glue_parse(struct device_node *udmax_np, 101d7024191SGrygorii Strashko struct k3_udma_glue_common *common) 102d7024191SGrygorii Strashko { 103d7024191SGrygorii Strashko common->udmax = of_xudma_dev_get(udmax_np, NULL); 104d7024191SGrygorii Strashko if (IS_ERR(common->udmax)) 105d7024191SGrygorii Strashko return PTR_ERR(common->udmax); 106d7024191SGrygorii Strashko 107aa8a4c4eSPeter Ujfalusi common->ringacc = xudma_get_ringacc(common->udmax); 108d7024191SGrygorii Strashko common->tisci_rm = xudma_dev_get_tisci_rm(common->udmax); 109d7024191SGrygorii Strashko 110d7024191SGrygorii Strashko return 0; 111d7024191SGrygorii Strashko } 112d7024191SGrygorii Strashko 113d7024191SGrygorii Strashko static int of_k3_udma_glue_parse_chn(struct device_node *chn_np, 114d7024191SGrygorii Strashko const char *name, struct k3_udma_glue_common *common, 115d7024191SGrygorii Strashko bool tx_chn) 116d7024191SGrygorii Strashko { 117d7024191SGrygorii Strashko struct of_phandle_args dma_spec; 118d7024191SGrygorii Strashko u32 thread_id; 119d7024191SGrygorii Strashko int ret = 0; 120d7024191SGrygorii Strashko int index; 121d7024191SGrygorii Strashko 122d7024191SGrygorii Strashko if (unlikely(!name)) 123d7024191SGrygorii Strashko return -EINVAL; 124d7024191SGrygorii Strashko 125d7024191SGrygorii Strashko index = of_property_match_string(chn_np, "dma-names", name); 126d7024191SGrygorii Strashko if (index < 0) 127d7024191SGrygorii Strashko return index; 128d7024191SGrygorii Strashko 129d7024191SGrygorii Strashko if (of_parse_phandle_with_args(chn_np, "dmas", "#dma-cells", index, 130d7024191SGrygorii Strashko &dma_spec)) 131d7024191SGrygorii Strashko return -ENOENT; 132d7024191SGrygorii Strashko 1335b65781dSVignesh Raghavendra ret = of_k3_udma_glue_parse(dma_spec.np, common); 1345b65781dSVignesh Raghavendra if (ret) 1355b65781dSVignesh Raghavendra goto out_put_spec; 1365b65781dSVignesh Raghavendra 137d7024191SGrygorii Strashko thread_id = dma_spec.args[0]; 1380ebcf1a2SPeter Ujfalusi if (dma_spec.args_count == 2) { 1395b65781dSVignesh Raghavendra if (dma_spec.args[1] > 2 && !xudma_is_pktdma(common->udmax)) { 1400ebcf1a2SPeter Ujfalusi dev_err(common->dev, "Invalid channel atype: %u\n", 1410ebcf1a2SPeter Ujfalusi dma_spec.args[1]); 1420ebcf1a2SPeter Ujfalusi ret = -EINVAL; 1430ebcf1a2SPeter Ujfalusi goto out_put_spec; 1440ebcf1a2SPeter Ujfalusi } 1455b65781dSVignesh Raghavendra if (dma_spec.args[1] > 15 && xudma_is_pktdma(common->udmax)) { 1465b65781dSVignesh Raghavendra dev_err(common->dev, "Invalid channel asel: %u\n", 1475b65781dSVignesh Raghavendra dma_spec.args[1]); 1485b65781dSVignesh Raghavendra ret = -EINVAL; 1495b65781dSVignesh Raghavendra goto out_put_spec; 1505b65781dSVignesh Raghavendra } 1515b65781dSVignesh Raghavendra 1525b65781dSVignesh Raghavendra common->atype_asel = dma_spec.args[1]; 1530ebcf1a2SPeter Ujfalusi } 154d7024191SGrygorii Strashko 155d7024191SGrygorii Strashko if (tx_chn && !(thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) { 156d7024191SGrygorii Strashko ret = -EINVAL; 157d7024191SGrygorii Strashko goto out_put_spec; 158d7024191SGrygorii Strashko } 159d7024191SGrygorii Strashko 160d7024191SGrygorii Strashko if (!tx_chn && (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET)) { 161d7024191SGrygorii Strashko ret = -EINVAL; 162d7024191SGrygorii Strashko goto out_put_spec; 163d7024191SGrygorii Strashko } 164d7024191SGrygorii Strashko 165d7024191SGrygorii Strashko /* get psil endpoint config */ 1665b65781dSVignesh Raghavendra common->ep_config = psil_get_ep_config(thread_id); 1675b65781dSVignesh Raghavendra if (IS_ERR(common->ep_config)) { 168d7024191SGrygorii Strashko dev_err(common->dev, 169d7024191SGrygorii Strashko "No configuration for psi-l thread 0x%04x\n", 170d7024191SGrygorii Strashko thread_id); 1715b65781dSVignesh Raghavendra ret = PTR_ERR(common->ep_config); 172d7024191SGrygorii Strashko goto out_put_spec; 173d7024191SGrygorii Strashko } 174d7024191SGrygorii Strashko 1755b65781dSVignesh Raghavendra common->epib = common->ep_config->needs_epib; 1765b65781dSVignesh Raghavendra common->psdata_size = common->ep_config->psd_size; 177d7024191SGrygorii Strashko 178d7024191SGrygorii Strashko if (tx_chn) 179d7024191SGrygorii Strashko common->dst_thread = thread_id; 180d7024191SGrygorii Strashko else 181d7024191SGrygorii Strashko common->src_thread = thread_id; 182d7024191SGrygorii Strashko 183d7024191SGrygorii Strashko out_put_spec: 184d7024191SGrygorii Strashko of_node_put(dma_spec.np); 185d7024191SGrygorii Strashko return ret; 186d7024191SGrygorii Strashko }; 187d7024191SGrygorii Strashko 188d7024191SGrygorii Strashko static void k3_udma_glue_dump_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 189d7024191SGrygorii Strashko { 190d7024191SGrygorii Strashko struct device *dev = tx_chn->common.dev; 191d7024191SGrygorii Strashko 192d7024191SGrygorii Strashko dev_dbg(dev, "dump_tx_chn:\n" 193d7024191SGrygorii Strashko "udma_tchan_id: %d\n" 194d7024191SGrygorii Strashko "src_thread: %08x\n" 195d7024191SGrygorii Strashko "dst_thread: %08x\n", 196d7024191SGrygorii Strashko tx_chn->udma_tchan_id, 197d7024191SGrygorii Strashko tx_chn->common.src_thread, 198d7024191SGrygorii Strashko tx_chn->common.dst_thread); 199d7024191SGrygorii Strashko } 200d7024191SGrygorii Strashko 201d7024191SGrygorii Strashko static void k3_udma_glue_dump_tx_rt_chn(struct k3_udma_glue_tx_channel *chn, 202d7024191SGrygorii Strashko char *mark) 203d7024191SGrygorii Strashko { 204d7024191SGrygorii Strashko struct device *dev = chn->common.dev; 205d7024191SGrygorii Strashko 206d7024191SGrygorii Strashko dev_dbg(dev, "=== dump ===> %s\n", mark); 207bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG, 208bc7e5523SPeter Ujfalusi xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG)); 209bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG, 210d7024191SGrygorii Strashko xudma_tchanrt_read(chn->udma_tchanx, 211bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_PEER_RT_EN_REG)); 212bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG, 213bc7e5523SPeter Ujfalusi xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_PCNT_REG)); 214bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG, 215bc7e5523SPeter Ujfalusi xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_BCNT_REG)); 216bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG, 217bc7e5523SPeter Ujfalusi xudma_tchanrt_read(chn->udma_tchanx, UDMA_CHAN_RT_SBCNT_REG)); 218d7024191SGrygorii Strashko } 219d7024191SGrygorii Strashko 220d7024191SGrygorii Strashko static int k3_udma_glue_cfg_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 221d7024191SGrygorii Strashko { 222d7024191SGrygorii Strashko const struct udma_tisci_rm *tisci_rm = tx_chn->common.tisci_rm; 223d7024191SGrygorii Strashko struct ti_sci_msg_rm_udmap_tx_ch_cfg req; 224d7024191SGrygorii Strashko 225d7024191SGrygorii Strashko memset(&req, 0, sizeof(req)); 226d7024191SGrygorii Strashko 227d7024191SGrygorii Strashko req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_PAUSE_ON_ERR_VALID | 228d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_EINFO_VALID | 229d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_FILT_PSWORDS_VALID | 230d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID | 231d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_TX_SUPR_TDPKT_VALID | 232d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID | 2330ebcf1a2SPeter Ujfalusi TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID | 2340ebcf1a2SPeter Ujfalusi TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID; 235d7024191SGrygorii Strashko req.nav_id = tisci_rm->tisci_dev_id; 236d7024191SGrygorii Strashko req.index = tx_chn->udma_tchan_id; 237d7024191SGrygorii Strashko if (tx_chn->tx_pause_on_err) 238d7024191SGrygorii Strashko req.tx_pause_on_err = 1; 239d7024191SGrygorii Strashko if (tx_chn->tx_filt_einfo) 240d7024191SGrygorii Strashko req.tx_filt_einfo = 1; 241d7024191SGrygorii Strashko if (tx_chn->tx_filt_pswords) 242d7024191SGrygorii Strashko req.tx_filt_pswords = 1; 243d7024191SGrygorii Strashko req.tx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR; 244d7024191SGrygorii Strashko if (tx_chn->tx_supr_tdpkt) 245d7024191SGrygorii Strashko req.tx_supr_tdpkt = 1; 246d7024191SGrygorii Strashko req.tx_fetch_size = tx_chn->common.hdesc_size >> 2; 247d7024191SGrygorii Strashko req.txcq_qnum = k3_ringacc_get_ring_id(tx_chn->ringtxcq); 2485b65781dSVignesh Raghavendra req.tx_atype = tx_chn->common.atype_asel; 249d7024191SGrygorii Strashko 250d7024191SGrygorii Strashko return tisci_rm->tisci_udmap_ops->tx_ch_cfg(tisci_rm->tisci, &req); 251d7024191SGrygorii Strashko } 252d7024191SGrygorii Strashko 253d7024191SGrygorii Strashko struct k3_udma_glue_tx_channel *k3_udma_glue_request_tx_chn(struct device *dev, 254d7024191SGrygorii Strashko const char *name, struct k3_udma_glue_tx_channel_cfg *cfg) 255d7024191SGrygorii Strashko { 256d7024191SGrygorii Strashko struct k3_udma_glue_tx_channel *tx_chn; 257d7024191SGrygorii Strashko int ret; 258d7024191SGrygorii Strashko 259d7024191SGrygorii Strashko tx_chn = devm_kzalloc(dev, sizeof(*tx_chn), GFP_KERNEL); 260d7024191SGrygorii Strashko if (!tx_chn) 261d7024191SGrygorii Strashko return ERR_PTR(-ENOMEM); 262d7024191SGrygorii Strashko 263d7024191SGrygorii Strashko tx_chn->common.dev = dev; 264d7024191SGrygorii Strashko tx_chn->common.swdata_size = cfg->swdata_size; 265d7024191SGrygorii Strashko tx_chn->tx_pause_on_err = cfg->tx_pause_on_err; 266d7024191SGrygorii Strashko tx_chn->tx_filt_einfo = cfg->tx_filt_einfo; 267d7024191SGrygorii Strashko tx_chn->tx_filt_pswords = cfg->tx_filt_pswords; 268d7024191SGrygorii Strashko tx_chn->tx_supr_tdpkt = cfg->tx_supr_tdpkt; 269d7024191SGrygorii Strashko 270d7024191SGrygorii Strashko /* parse of udmap channel */ 271d7024191SGrygorii Strashko ret = of_k3_udma_glue_parse_chn(dev->of_node, name, 272d7024191SGrygorii Strashko &tx_chn->common, true); 273d7024191SGrygorii Strashko if (ret) 274d7024191SGrygorii Strashko goto err; 275d7024191SGrygorii Strashko 276d7024191SGrygorii Strashko tx_chn->common.hdesc_size = cppi5_hdesc_calc_size(tx_chn->common.epib, 277d7024191SGrygorii Strashko tx_chn->common.psdata_size, 278d7024191SGrygorii Strashko tx_chn->common.swdata_size); 279d7024191SGrygorii Strashko 2805b65781dSVignesh Raghavendra if (xudma_is_pktdma(tx_chn->common.udmax)) 2815b65781dSVignesh Raghavendra tx_chn->udma_tchan_id = tx_chn->common.ep_config->mapped_channel_id; 2825b65781dSVignesh Raghavendra else 2835b65781dSVignesh Raghavendra tx_chn->udma_tchan_id = -1; 2845b65781dSVignesh Raghavendra 285d7024191SGrygorii Strashko /* request and cfg UDMAP TX channel */ 2865b65781dSVignesh Raghavendra tx_chn->udma_tchanx = xudma_tchan_get(tx_chn->common.udmax, 2875b65781dSVignesh Raghavendra tx_chn->udma_tchan_id); 288d7024191SGrygorii Strashko if (IS_ERR(tx_chn->udma_tchanx)) { 289d7024191SGrygorii Strashko ret = PTR_ERR(tx_chn->udma_tchanx); 290d7024191SGrygorii Strashko dev_err(dev, "UDMAX tchanx get err %d\n", ret); 291d7024191SGrygorii Strashko goto err; 292d7024191SGrygorii Strashko } 293d7024191SGrygorii Strashko tx_chn->udma_tchan_id = xudma_tchan_get_id(tx_chn->udma_tchanx); 294d7024191SGrygorii Strashko 2955b65781dSVignesh Raghavendra tx_chn->common.chan_dev.class = &k3_udma_glue_devclass; 2965b65781dSVignesh Raghavendra tx_chn->common.chan_dev.parent = xudma_get_device(tx_chn->common.udmax); 2975b65781dSVignesh Raghavendra dev_set_name(&tx_chn->common.chan_dev, "tchan%d-0x%04x", 2985b65781dSVignesh Raghavendra tx_chn->udma_tchan_id, tx_chn->common.dst_thread); 2995b65781dSVignesh Raghavendra ret = device_register(&tx_chn->common.chan_dev); 3005b65781dSVignesh Raghavendra if (ret) { 3015b65781dSVignesh Raghavendra dev_err(dev, "Channel Device registration failed %d\n", ret); 302*ac2b9f34SYang Yingliang put_device(&tx_chn->common.chan_dev); 3035b65781dSVignesh Raghavendra tx_chn->common.chan_dev.parent = NULL; 3045b65781dSVignesh Raghavendra goto err; 3055b65781dSVignesh Raghavendra } 3065b65781dSVignesh Raghavendra 3075b65781dSVignesh Raghavendra if (xudma_is_pktdma(tx_chn->common.udmax)) { 3085b65781dSVignesh Raghavendra /* prepare the channel device as coherent */ 3095b65781dSVignesh Raghavendra tx_chn->common.chan_dev.dma_coherent = true; 3105b65781dSVignesh Raghavendra dma_coerce_mask_and_coherent(&tx_chn->common.chan_dev, 3115b65781dSVignesh Raghavendra DMA_BIT_MASK(48)); 3125b65781dSVignesh Raghavendra } 3135b65781dSVignesh Raghavendra 314d7024191SGrygorii Strashko atomic_set(&tx_chn->free_pkts, cfg->txcq_cfg.size); 315d7024191SGrygorii Strashko 3165b65781dSVignesh Raghavendra if (xudma_is_pktdma(tx_chn->common.udmax)) 3175b65781dSVignesh Raghavendra tx_chn->udma_tflow_id = tx_chn->common.ep_config->default_flow_id; 3185b65781dSVignesh Raghavendra else 3195b65781dSVignesh Raghavendra tx_chn->udma_tflow_id = tx_chn->udma_tchan_id; 3205b65781dSVignesh Raghavendra 321d7024191SGrygorii Strashko /* request and cfg rings */ 3224927b1abSPeter Ujfalusi ret = k3_ringacc_request_rings_pair(tx_chn->common.ringacc, 3235b65781dSVignesh Raghavendra tx_chn->udma_tflow_id, -1, 3244927b1abSPeter Ujfalusi &tx_chn->ringtx, 3254927b1abSPeter Ujfalusi &tx_chn->ringtxcq); 3264927b1abSPeter Ujfalusi if (ret) { 3274927b1abSPeter Ujfalusi dev_err(dev, "Failed to get TX/TXCQ rings %d\n", ret); 328d7024191SGrygorii Strashko goto err; 329d7024191SGrygorii Strashko } 330d7024191SGrygorii Strashko 331d553e2abSPeter Ujfalusi /* Set the dma_dev for the rings to be configured */ 332d553e2abSPeter Ujfalusi cfg->tx_cfg.dma_dev = k3_udma_glue_tx_get_dma_device(tx_chn); 333d553e2abSPeter Ujfalusi cfg->txcq_cfg.dma_dev = cfg->tx_cfg.dma_dev; 334d553e2abSPeter Ujfalusi 3355b65781dSVignesh Raghavendra /* Set the ASEL value for DMA rings of PKTDMA */ 3365b65781dSVignesh Raghavendra if (xudma_is_pktdma(tx_chn->common.udmax)) { 3375b65781dSVignesh Raghavendra cfg->tx_cfg.asel = tx_chn->common.atype_asel; 3385b65781dSVignesh Raghavendra cfg->txcq_cfg.asel = tx_chn->common.atype_asel; 3395b65781dSVignesh Raghavendra } 3405b65781dSVignesh Raghavendra 341d7024191SGrygorii Strashko ret = k3_ringacc_ring_cfg(tx_chn->ringtx, &cfg->tx_cfg); 342d7024191SGrygorii Strashko if (ret) { 343d7024191SGrygorii Strashko dev_err(dev, "Failed to cfg ringtx %d\n", ret); 344d7024191SGrygorii Strashko goto err; 345d7024191SGrygorii Strashko } 346d7024191SGrygorii Strashko 347d7024191SGrygorii Strashko ret = k3_ringacc_ring_cfg(tx_chn->ringtxcq, &cfg->txcq_cfg); 348d7024191SGrygorii Strashko if (ret) { 349d7024191SGrygorii Strashko dev_err(dev, "Failed to cfg ringtx %d\n", ret); 350d7024191SGrygorii Strashko goto err; 351d7024191SGrygorii Strashko } 352d7024191SGrygorii Strashko 353d7024191SGrygorii Strashko /* request and cfg psi-l */ 354d7024191SGrygorii Strashko tx_chn->common.src_thread = 355d7024191SGrygorii Strashko xudma_dev_get_psil_base(tx_chn->common.udmax) + 356d7024191SGrygorii Strashko tx_chn->udma_tchan_id; 357d7024191SGrygorii Strashko 358d7024191SGrygorii Strashko ret = k3_udma_glue_cfg_tx_chn(tx_chn); 359d7024191SGrygorii Strashko if (ret) { 360d7024191SGrygorii Strashko dev_err(dev, "Failed to cfg tchan %d\n", ret); 361d7024191SGrygorii Strashko goto err; 362d7024191SGrygorii Strashko } 363d7024191SGrygorii Strashko 364d7024191SGrygorii Strashko k3_udma_glue_dump_tx_chn(tx_chn); 365d7024191SGrygorii Strashko 366d7024191SGrygorii Strashko return tx_chn; 367d7024191SGrygorii Strashko 368d7024191SGrygorii Strashko err: 369d7024191SGrygorii Strashko k3_udma_glue_release_tx_chn(tx_chn); 370d7024191SGrygorii Strashko return ERR_PTR(ret); 371d7024191SGrygorii Strashko } 372d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_request_tx_chn); 373d7024191SGrygorii Strashko 374d7024191SGrygorii Strashko void k3_udma_glue_release_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 375d7024191SGrygorii Strashko { 376d7024191SGrygorii Strashko if (tx_chn->psil_paired) { 377d7024191SGrygorii Strashko xudma_navss_psil_unpair(tx_chn->common.udmax, 378d7024191SGrygorii Strashko tx_chn->common.src_thread, 379d7024191SGrygorii Strashko tx_chn->common.dst_thread); 380d7024191SGrygorii Strashko tx_chn->psil_paired = false; 381d7024191SGrygorii Strashko } 382d7024191SGrygorii Strashko 383d7024191SGrygorii Strashko if (!IS_ERR_OR_NULL(tx_chn->udma_tchanx)) 384d7024191SGrygorii Strashko xudma_tchan_put(tx_chn->common.udmax, 385d7024191SGrygorii Strashko tx_chn->udma_tchanx); 386d7024191SGrygorii Strashko 387d7024191SGrygorii Strashko if (tx_chn->ringtxcq) 388d7024191SGrygorii Strashko k3_ringacc_ring_free(tx_chn->ringtxcq); 389d7024191SGrygorii Strashko 390d7024191SGrygorii Strashko if (tx_chn->ringtx) 391d7024191SGrygorii Strashko k3_ringacc_ring_free(tx_chn->ringtx); 3925b65781dSVignesh Raghavendra 3935b65781dSVignesh Raghavendra if (tx_chn->common.chan_dev.parent) { 3945b65781dSVignesh Raghavendra device_unregister(&tx_chn->common.chan_dev); 3955b65781dSVignesh Raghavendra tx_chn->common.chan_dev.parent = NULL; 3965b65781dSVignesh Raghavendra } 397d7024191SGrygorii Strashko } 398d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_release_tx_chn); 399d7024191SGrygorii Strashko 400d7024191SGrygorii Strashko int k3_udma_glue_push_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 401d7024191SGrygorii Strashko struct cppi5_host_desc_t *desc_tx, 402d7024191SGrygorii Strashko dma_addr_t desc_dma) 403d7024191SGrygorii Strashko { 404d7024191SGrygorii Strashko u32 ringtxcq_id; 405d7024191SGrygorii Strashko 406d7024191SGrygorii Strashko if (!atomic_add_unless(&tx_chn->free_pkts, -1, 0)) 407d7024191SGrygorii Strashko return -ENOMEM; 408d7024191SGrygorii Strashko 409d7024191SGrygorii Strashko ringtxcq_id = k3_ringacc_get_ring_id(tx_chn->ringtxcq); 410d7024191SGrygorii Strashko cppi5_desc_set_retpolicy(&desc_tx->hdr, 0, ringtxcq_id); 411d7024191SGrygorii Strashko 412d7024191SGrygorii Strashko return k3_ringacc_ring_push(tx_chn->ringtx, &desc_dma); 413d7024191SGrygorii Strashko } 414d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_push_tx_chn); 415d7024191SGrygorii Strashko 416d7024191SGrygorii Strashko int k3_udma_glue_pop_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 417d7024191SGrygorii Strashko dma_addr_t *desc_dma) 418d7024191SGrygorii Strashko { 419d7024191SGrygorii Strashko int ret; 420d7024191SGrygorii Strashko 421d7024191SGrygorii Strashko ret = k3_ringacc_ring_pop(tx_chn->ringtxcq, desc_dma); 422d7024191SGrygorii Strashko if (!ret) 423d7024191SGrygorii Strashko atomic_inc(&tx_chn->free_pkts); 424d7024191SGrygorii Strashko 425d7024191SGrygorii Strashko return ret; 426d7024191SGrygorii Strashko } 427d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_pop_tx_chn); 428d7024191SGrygorii Strashko 429d7024191SGrygorii Strashko int k3_udma_glue_enable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 430d7024191SGrygorii Strashko { 43169973b48SGrygorii Strashko int ret; 43269973b48SGrygorii Strashko 43369973b48SGrygorii Strashko ret = xudma_navss_psil_pair(tx_chn->common.udmax, 43469973b48SGrygorii Strashko tx_chn->common.src_thread, 43569973b48SGrygorii Strashko tx_chn->common.dst_thread); 43669973b48SGrygorii Strashko if (ret) { 43769973b48SGrygorii Strashko dev_err(tx_chn->common.dev, "PSI-L request err %d\n", ret); 43869973b48SGrygorii Strashko return ret; 43969973b48SGrygorii Strashko } 44069973b48SGrygorii Strashko 44169973b48SGrygorii Strashko tx_chn->psil_paired = true; 44269973b48SGrygorii Strashko 443bc7e5523SPeter Ujfalusi xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_PEER_RT_EN_REG, 44452c74d3dSGrygorii Strashko UDMA_PEER_RT_EN_ENABLE); 445d7024191SGrygorii Strashko 446bc7e5523SPeter Ujfalusi xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 44752c74d3dSGrygorii Strashko UDMA_CHAN_RT_CTL_EN); 448d7024191SGrygorii Strashko 449d7024191SGrygorii Strashko k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn en"); 450d7024191SGrygorii Strashko return 0; 451d7024191SGrygorii Strashko } 452d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_enable_tx_chn); 453d7024191SGrygorii Strashko 454d7024191SGrygorii Strashko void k3_udma_glue_disable_tx_chn(struct k3_udma_glue_tx_channel *tx_chn) 455d7024191SGrygorii Strashko { 456d7024191SGrygorii Strashko k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis1"); 457d7024191SGrygorii Strashko 458bc7e5523SPeter Ujfalusi xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 0); 459d7024191SGrygorii Strashko 460d7024191SGrygorii Strashko xudma_tchanrt_write(tx_chn->udma_tchanx, 461bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_PEER_RT_EN_REG, 0); 462d7024191SGrygorii Strashko k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn dis2"); 46369973b48SGrygorii Strashko 46469973b48SGrygorii Strashko if (tx_chn->psil_paired) { 46569973b48SGrygorii Strashko xudma_navss_psil_unpair(tx_chn->common.udmax, 46669973b48SGrygorii Strashko tx_chn->common.src_thread, 46769973b48SGrygorii Strashko tx_chn->common.dst_thread); 46869973b48SGrygorii Strashko tx_chn->psil_paired = false; 46969973b48SGrygorii Strashko } 470d7024191SGrygorii Strashko } 471d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_disable_tx_chn); 472d7024191SGrygorii Strashko 473d7024191SGrygorii Strashko void k3_udma_glue_tdown_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 474d7024191SGrygorii Strashko bool sync) 475d7024191SGrygorii Strashko { 476d7024191SGrygorii Strashko int i = 0; 477d7024191SGrygorii Strashko u32 val; 478d7024191SGrygorii Strashko 479d7024191SGrygorii Strashko k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown1"); 480d7024191SGrygorii Strashko 481bc7e5523SPeter Ujfalusi xudma_tchanrt_write(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG, 482d7024191SGrygorii Strashko UDMA_CHAN_RT_CTL_EN | UDMA_CHAN_RT_CTL_TDOWN); 483d7024191SGrygorii Strashko 484bc7e5523SPeter Ujfalusi val = xudma_tchanrt_read(tx_chn->udma_tchanx, UDMA_CHAN_RT_CTL_REG); 485d7024191SGrygorii Strashko 486d7024191SGrygorii Strashko while (sync && (val & UDMA_CHAN_RT_CTL_EN)) { 487d7024191SGrygorii Strashko val = xudma_tchanrt_read(tx_chn->udma_tchanx, 488bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_CTL_REG); 489d7024191SGrygorii Strashko udelay(1); 490d7024191SGrygorii Strashko if (i > K3_UDMAX_TDOWN_TIMEOUT_US) { 491d7024191SGrygorii Strashko dev_err(tx_chn->common.dev, "TX tdown timeout\n"); 492d7024191SGrygorii Strashko break; 493d7024191SGrygorii Strashko } 494d7024191SGrygorii Strashko i++; 495d7024191SGrygorii Strashko } 496d7024191SGrygorii Strashko 497d7024191SGrygorii Strashko val = xudma_tchanrt_read(tx_chn->udma_tchanx, 498bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_PEER_RT_EN_REG); 499d7024191SGrygorii Strashko if (sync && (val & UDMA_PEER_RT_EN_ENABLE)) 500d7024191SGrygorii Strashko dev_err(tx_chn->common.dev, "TX tdown peer not stopped\n"); 501d7024191SGrygorii Strashko k3_udma_glue_dump_tx_rt_chn(tx_chn, "txchn tdown2"); 502d7024191SGrygorii Strashko } 503d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tdown_tx_chn); 504d7024191SGrygorii Strashko 505d7024191SGrygorii Strashko void k3_udma_glue_reset_tx_chn(struct k3_udma_glue_tx_channel *tx_chn, 506d7024191SGrygorii Strashko void *data, 507d7024191SGrygorii Strashko void (*cleanup)(void *data, dma_addr_t desc_dma)) 508d7024191SGrygorii Strashko { 5095b65781dSVignesh Raghavendra struct device *dev = tx_chn->common.dev; 510d7024191SGrygorii Strashko dma_addr_t desc_dma; 511d7024191SGrygorii Strashko int occ_tx, i, ret; 512d7024191SGrygorii Strashko 513d7024191SGrygorii Strashko /* 514d7024191SGrygorii Strashko * TXQ reset need to be special way as it is input for udma and its 515d7024191SGrygorii Strashko * state cached by udma, so: 516d7024191SGrygorii Strashko * 1) save TXQ occ 517d7024191SGrygorii Strashko * 2) clean up TXQ and call callback .cleanup() for each desc 518d7024191SGrygorii Strashko * 3) reset TXQ in a special way 519d7024191SGrygorii Strashko */ 520d7024191SGrygorii Strashko occ_tx = k3_ringacc_ring_get_occ(tx_chn->ringtx); 5215b65781dSVignesh Raghavendra dev_dbg(dev, "TX reset occ_tx %u\n", occ_tx); 522d7024191SGrygorii Strashko 523d7024191SGrygorii Strashko for (i = 0; i < occ_tx; i++) { 524d7024191SGrygorii Strashko ret = k3_ringacc_ring_pop(tx_chn->ringtx, &desc_dma); 525d7024191SGrygorii Strashko if (ret) { 5265b65781dSVignesh Raghavendra if (ret != -ENODATA) 5275b65781dSVignesh Raghavendra dev_err(dev, "TX reset pop %d\n", ret); 528d7024191SGrygorii Strashko break; 529d7024191SGrygorii Strashko } 530d7024191SGrygorii Strashko cleanup(data, desc_dma); 531d7024191SGrygorii Strashko } 532d7024191SGrygorii Strashko 5335b65781dSVignesh Raghavendra /* reset TXCQ as it is not input for udma - expected to be empty */ 5345b65781dSVignesh Raghavendra k3_ringacc_ring_reset(tx_chn->ringtxcq); 535d7024191SGrygorii Strashko k3_ringacc_ring_reset_dma(tx_chn->ringtx, occ_tx); 536d7024191SGrygorii Strashko } 537d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_reset_tx_chn); 538d7024191SGrygorii Strashko 539d7024191SGrygorii Strashko u32 k3_udma_glue_tx_get_hdesc_size(struct k3_udma_glue_tx_channel *tx_chn) 540d7024191SGrygorii Strashko { 541d7024191SGrygorii Strashko return tx_chn->common.hdesc_size; 542d7024191SGrygorii Strashko } 543d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_hdesc_size); 544d7024191SGrygorii Strashko 545d7024191SGrygorii Strashko u32 k3_udma_glue_tx_get_txcq_id(struct k3_udma_glue_tx_channel *tx_chn) 546d7024191SGrygorii Strashko { 547d7024191SGrygorii Strashko return k3_ringacc_get_ring_id(tx_chn->ringtxcq); 548d7024191SGrygorii Strashko } 549d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_txcq_id); 550d7024191SGrygorii Strashko 551d7024191SGrygorii Strashko int k3_udma_glue_tx_get_irq(struct k3_udma_glue_tx_channel *tx_chn) 552d7024191SGrygorii Strashko { 5535b65781dSVignesh Raghavendra if (xudma_is_pktdma(tx_chn->common.udmax)) { 5545b65781dSVignesh Raghavendra tx_chn->virq = xudma_pktdma_tflow_get_irq(tx_chn->common.udmax, 5555b65781dSVignesh Raghavendra tx_chn->udma_tflow_id); 5565b65781dSVignesh Raghavendra } else { 557d7024191SGrygorii Strashko tx_chn->virq = k3_ringacc_get_ring_irq_num(tx_chn->ringtxcq); 5585b65781dSVignesh Raghavendra } 559d7024191SGrygorii Strashko 560d7024191SGrygorii Strashko return tx_chn->virq; 561d7024191SGrygorii Strashko } 562d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_irq); 563d7024191SGrygorii Strashko 564426506a7SPeter Ujfalusi struct device * 565426506a7SPeter Ujfalusi k3_udma_glue_tx_get_dma_device(struct k3_udma_glue_tx_channel *tx_chn) 566426506a7SPeter Ujfalusi { 5675b65781dSVignesh Raghavendra if (xudma_is_pktdma(tx_chn->common.udmax) && 5685b65781dSVignesh Raghavendra (tx_chn->common.atype_asel == 14 || tx_chn->common.atype_asel == 15)) 5695b65781dSVignesh Raghavendra return &tx_chn->common.chan_dev; 5705b65781dSVignesh Raghavendra 571426506a7SPeter Ujfalusi return xudma_get_device(tx_chn->common.udmax); 572426506a7SPeter Ujfalusi } 573426506a7SPeter Ujfalusi EXPORT_SYMBOL_GPL(k3_udma_glue_tx_get_dma_device); 574426506a7SPeter Ujfalusi 5755b65781dSVignesh Raghavendra void k3_udma_glue_tx_dma_to_cppi5_addr(struct k3_udma_glue_tx_channel *tx_chn, 5765b65781dSVignesh Raghavendra dma_addr_t *addr) 5775b65781dSVignesh Raghavendra { 5785b65781dSVignesh Raghavendra if (!xudma_is_pktdma(tx_chn->common.udmax) || 5795b65781dSVignesh Raghavendra !tx_chn->common.atype_asel) 5805b65781dSVignesh Raghavendra return; 5815b65781dSVignesh Raghavendra 5825b65781dSVignesh Raghavendra *addr |= (u64)tx_chn->common.atype_asel << K3_ADDRESS_ASEL_SHIFT; 5835b65781dSVignesh Raghavendra } 5845b65781dSVignesh Raghavendra EXPORT_SYMBOL_GPL(k3_udma_glue_tx_dma_to_cppi5_addr); 5855b65781dSVignesh Raghavendra 5865b65781dSVignesh Raghavendra void k3_udma_glue_tx_cppi5_to_dma_addr(struct k3_udma_glue_tx_channel *tx_chn, 5875b65781dSVignesh Raghavendra dma_addr_t *addr) 5885b65781dSVignesh Raghavendra { 5895b65781dSVignesh Raghavendra if (!xudma_is_pktdma(tx_chn->common.udmax) || 5905b65781dSVignesh Raghavendra !tx_chn->common.atype_asel) 5915b65781dSVignesh Raghavendra return; 5925b65781dSVignesh Raghavendra 5935b65781dSVignesh Raghavendra *addr &= (u64)GENMASK(K3_ADDRESS_ASEL_SHIFT - 1, 0); 5945b65781dSVignesh Raghavendra } 5955b65781dSVignesh Raghavendra EXPORT_SYMBOL_GPL(k3_udma_glue_tx_cppi5_to_dma_addr); 5965b65781dSVignesh Raghavendra 597d7024191SGrygorii Strashko static int k3_udma_glue_cfg_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 598d7024191SGrygorii Strashko { 599d7024191SGrygorii Strashko const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 600d7024191SGrygorii Strashko struct ti_sci_msg_rm_udmap_rx_ch_cfg req; 601d7024191SGrygorii Strashko int ret; 602d7024191SGrygorii Strashko 603d7024191SGrygorii Strashko memset(&req, 0, sizeof(req)); 604d7024191SGrygorii Strashko 605d7024191SGrygorii Strashko req.valid_params = TI_SCI_MSG_VALUE_RM_UDMAP_CH_FETCH_SIZE_VALID | 606d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_CQ_QNUM_VALID | 607d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_CH_CHAN_TYPE_VALID | 6080ebcf1a2SPeter Ujfalusi TI_SCI_MSG_VALUE_RM_UDMAP_CH_ATYPE_VALID; 609d7024191SGrygorii Strashko 610d7024191SGrygorii Strashko req.nav_id = tisci_rm->tisci_dev_id; 611d7024191SGrygorii Strashko req.index = rx_chn->udma_rchan_id; 612d7024191SGrygorii Strashko req.rx_fetch_size = rx_chn->common.hdesc_size >> 2; 613d7024191SGrygorii Strashko /* 614d7024191SGrygorii Strashko * TODO: we can't support rxcq_qnum/RCHAN[a]_RCQ cfg with current sysfw 615d7024191SGrygorii Strashko * and udmax impl, so just configure it to invalid value. 616d7024191SGrygorii Strashko * req.rxcq_qnum = k3_ringacc_get_ring_id(rx_chn->flows[0].ringrx); 617d7024191SGrygorii Strashko */ 618d7024191SGrygorii Strashko req.rxcq_qnum = 0xFFFF; 6195b65781dSVignesh Raghavendra if (!xudma_is_pktdma(rx_chn->common.udmax) && rx_chn->flow_num && 6205b65781dSVignesh Raghavendra rx_chn->flow_id_base != rx_chn->udma_rchan_id) { 621d7024191SGrygorii Strashko /* Default flow + extra ones */ 6225b65781dSVignesh Raghavendra req.valid_params |= TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_START_VALID | 6235b65781dSVignesh Raghavendra TI_SCI_MSG_VALUE_RM_UDMAP_CH_RX_FLOWID_CNT_VALID; 624d7024191SGrygorii Strashko req.flowid_start = rx_chn->flow_id_base; 625d7024191SGrygorii Strashko req.flowid_cnt = rx_chn->flow_num; 626d7024191SGrygorii Strashko } 627d7024191SGrygorii Strashko req.rx_chan_type = TI_SCI_RM_UDMAP_CHAN_TYPE_PKT_PBRR; 6285b65781dSVignesh Raghavendra req.rx_atype = rx_chn->common.atype_asel; 629d7024191SGrygorii Strashko 630d7024191SGrygorii Strashko ret = tisci_rm->tisci_udmap_ops->rx_ch_cfg(tisci_rm->tisci, &req); 631d7024191SGrygorii Strashko if (ret) 632d7024191SGrygorii Strashko dev_err(rx_chn->common.dev, "rchan%d cfg failed %d\n", 633d7024191SGrygorii Strashko rx_chn->udma_rchan_id, ret); 634d7024191SGrygorii Strashko 635d7024191SGrygorii Strashko return ret; 636d7024191SGrygorii Strashko } 637d7024191SGrygorii Strashko 638d7024191SGrygorii Strashko static void k3_udma_glue_release_rx_flow(struct k3_udma_glue_rx_channel *rx_chn, 639d7024191SGrygorii Strashko u32 flow_num) 640d7024191SGrygorii Strashko { 641d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 642d7024191SGrygorii Strashko 643d7024191SGrygorii Strashko if (IS_ERR_OR_NULL(flow->udma_rflow)) 644d7024191SGrygorii Strashko return; 645d7024191SGrygorii Strashko 646d7024191SGrygorii Strashko if (flow->ringrxfdq) 647d7024191SGrygorii Strashko k3_ringacc_ring_free(flow->ringrxfdq); 648d7024191SGrygorii Strashko 649d7024191SGrygorii Strashko if (flow->ringrx) 650d7024191SGrygorii Strashko k3_ringacc_ring_free(flow->ringrx); 651d7024191SGrygorii Strashko 652d7024191SGrygorii Strashko xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow); 653d7024191SGrygorii Strashko flow->udma_rflow = NULL; 654d7024191SGrygorii Strashko rx_chn->flows_ready--; 655d7024191SGrygorii Strashko } 656d7024191SGrygorii Strashko 657d7024191SGrygorii Strashko static int k3_udma_glue_cfg_rx_flow(struct k3_udma_glue_rx_channel *rx_chn, 658d7024191SGrygorii Strashko u32 flow_idx, 659d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow_cfg *flow_cfg) 660d7024191SGrygorii Strashko { 661d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx]; 662d7024191SGrygorii Strashko const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 663d7024191SGrygorii Strashko struct device *dev = rx_chn->common.dev; 664d7024191SGrygorii Strashko struct ti_sci_msg_rm_udmap_flow_cfg req; 665d7024191SGrygorii Strashko int rx_ring_id; 666d7024191SGrygorii Strashko int rx_ringfdq_id; 667d7024191SGrygorii Strashko int ret = 0; 668d7024191SGrygorii Strashko 669d7024191SGrygorii Strashko flow->udma_rflow = xudma_rflow_get(rx_chn->common.udmax, 670d7024191SGrygorii Strashko flow->udma_rflow_id); 671d7024191SGrygorii Strashko if (IS_ERR(flow->udma_rflow)) { 672d7024191SGrygorii Strashko ret = PTR_ERR(flow->udma_rflow); 673d7024191SGrygorii Strashko dev_err(dev, "UDMAX rflow get err %d\n", ret); 674018af9beSChristophe JAILLET return ret; 675d7024191SGrygorii Strashko } 676d7024191SGrygorii Strashko 677d7024191SGrygorii Strashko if (flow->udma_rflow_id != xudma_rflow_get_id(flow->udma_rflow)) { 678018af9beSChristophe JAILLET ret = -ENODEV; 679018af9beSChristophe JAILLET goto err_rflow_put; 680d7024191SGrygorii Strashko } 681d7024191SGrygorii Strashko 6825b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) { 6835b65781dSVignesh Raghavendra rx_ringfdq_id = flow->udma_rflow_id + 6845b65781dSVignesh Raghavendra xudma_get_rflow_ring_offset(rx_chn->common.udmax); 6855b65781dSVignesh Raghavendra rx_ring_id = 0; 6865b65781dSVignesh Raghavendra } else { 6875b65781dSVignesh Raghavendra rx_ring_id = flow_cfg->ring_rxq_id; 6885b65781dSVignesh Raghavendra rx_ringfdq_id = flow_cfg->ring_rxfdq0_id; 6895b65781dSVignesh Raghavendra } 6905b65781dSVignesh Raghavendra 691d7024191SGrygorii Strashko /* request and cfg rings */ 6924927b1abSPeter Ujfalusi ret = k3_ringacc_request_rings_pair(rx_chn->common.ringacc, 6935b65781dSVignesh Raghavendra rx_ringfdq_id, rx_ring_id, 6944927b1abSPeter Ujfalusi &flow->ringrxfdq, 6954927b1abSPeter Ujfalusi &flow->ringrx); 6964927b1abSPeter Ujfalusi if (ret) { 6974927b1abSPeter Ujfalusi dev_err(dev, "Failed to get RX/RXFDQ rings %d\n", ret); 698018af9beSChristophe JAILLET goto err_rflow_put; 699d7024191SGrygorii Strashko } 700d7024191SGrygorii Strashko 701d553e2abSPeter Ujfalusi /* Set the dma_dev for the rings to be configured */ 702d553e2abSPeter Ujfalusi flow_cfg->rx_cfg.dma_dev = k3_udma_glue_rx_get_dma_device(rx_chn); 703d553e2abSPeter Ujfalusi flow_cfg->rxfdq_cfg.dma_dev = flow_cfg->rx_cfg.dma_dev; 704d553e2abSPeter Ujfalusi 7055b65781dSVignesh Raghavendra /* Set the ASEL value for DMA rings of PKTDMA */ 7065b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) { 7075b65781dSVignesh Raghavendra flow_cfg->rx_cfg.asel = rx_chn->common.atype_asel; 7085b65781dSVignesh Raghavendra flow_cfg->rxfdq_cfg.asel = rx_chn->common.atype_asel; 7095b65781dSVignesh Raghavendra } 7105b65781dSVignesh Raghavendra 711d7024191SGrygorii Strashko ret = k3_ringacc_ring_cfg(flow->ringrx, &flow_cfg->rx_cfg); 712d7024191SGrygorii Strashko if (ret) { 713d7024191SGrygorii Strashko dev_err(dev, "Failed to cfg ringrx %d\n", ret); 714018af9beSChristophe JAILLET goto err_ringrxfdq_free; 715d7024191SGrygorii Strashko } 716d7024191SGrygorii Strashko 717d7024191SGrygorii Strashko ret = k3_ringacc_ring_cfg(flow->ringrxfdq, &flow_cfg->rxfdq_cfg); 718d7024191SGrygorii Strashko if (ret) { 719d7024191SGrygorii Strashko dev_err(dev, "Failed to cfg ringrxfdq %d\n", ret); 720018af9beSChristophe JAILLET goto err_ringrxfdq_free; 721d7024191SGrygorii Strashko } 722d7024191SGrygorii Strashko 723d7024191SGrygorii Strashko if (rx_chn->remote) { 724d7024191SGrygorii Strashko rx_ring_id = TI_SCI_RESOURCE_NULL; 725d7024191SGrygorii Strashko rx_ringfdq_id = TI_SCI_RESOURCE_NULL; 726d7024191SGrygorii Strashko } else { 727d7024191SGrygorii Strashko rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx); 728d7024191SGrygorii Strashko rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq); 729d7024191SGrygorii Strashko } 730d7024191SGrygorii Strashko 731d7024191SGrygorii Strashko memset(&req, 0, sizeof(req)); 732d7024191SGrygorii Strashko 733d7024191SGrygorii Strashko req.valid_params = 734d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_EINFO_PRESENT_VALID | 735d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_PSINFO_PRESENT_VALID | 736d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_ERROR_HANDLING_VALID | 737d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DESC_TYPE_VALID | 738d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID | 739d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_HI_SEL_VALID | 740d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_SRC_TAG_LO_SEL_VALID | 741d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_HI_SEL_VALID | 742d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_TAG_LO_SEL_VALID | 743d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID | 744d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID | 745d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID | 746d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID; 747d7024191SGrygorii Strashko req.nav_id = tisci_rm->tisci_dev_id; 748d7024191SGrygorii Strashko req.flow_index = flow->udma_rflow_id; 749d7024191SGrygorii Strashko if (rx_chn->common.epib) 750d7024191SGrygorii Strashko req.rx_einfo_present = 1; 751d7024191SGrygorii Strashko if (rx_chn->common.psdata_size) 752d7024191SGrygorii Strashko req.rx_psinfo_present = 1; 753d7024191SGrygorii Strashko if (flow_cfg->rx_error_handling) 754d7024191SGrygorii Strashko req.rx_error_handling = 1; 755d7024191SGrygorii Strashko req.rx_desc_type = 0; 756d7024191SGrygorii Strashko req.rx_dest_qnum = rx_ring_id; 757d7024191SGrygorii Strashko req.rx_src_tag_hi_sel = 0; 758d7024191SGrygorii Strashko req.rx_src_tag_lo_sel = flow_cfg->src_tag_lo_sel; 759d7024191SGrygorii Strashko req.rx_dest_tag_hi_sel = 0; 760d7024191SGrygorii Strashko req.rx_dest_tag_lo_sel = 0; 761d7024191SGrygorii Strashko req.rx_fdq0_sz0_qnum = rx_ringfdq_id; 762d7024191SGrygorii Strashko req.rx_fdq1_qnum = rx_ringfdq_id; 763d7024191SGrygorii Strashko req.rx_fdq2_qnum = rx_ringfdq_id; 764d7024191SGrygorii Strashko req.rx_fdq3_qnum = rx_ringfdq_id; 765d7024191SGrygorii Strashko 766d7024191SGrygorii Strashko ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req); 767d7024191SGrygorii Strashko if (ret) { 768d7024191SGrygorii Strashko dev_err(dev, "flow%d config failed: %d\n", flow->udma_rflow_id, 769d7024191SGrygorii Strashko ret); 770018af9beSChristophe JAILLET goto err_ringrxfdq_free; 771d7024191SGrygorii Strashko } 772d7024191SGrygorii Strashko 773d7024191SGrygorii Strashko rx_chn->flows_ready++; 774d7024191SGrygorii Strashko dev_dbg(dev, "flow%d config done. ready:%d\n", 775d7024191SGrygorii Strashko flow->udma_rflow_id, rx_chn->flows_ready); 776d7024191SGrygorii Strashko 777d7024191SGrygorii Strashko return 0; 778018af9beSChristophe JAILLET 779018af9beSChristophe JAILLET err_ringrxfdq_free: 780018af9beSChristophe JAILLET k3_ringacc_ring_free(flow->ringrxfdq); 781018af9beSChristophe JAILLET k3_ringacc_ring_free(flow->ringrx); 782018af9beSChristophe JAILLET 783018af9beSChristophe JAILLET err_rflow_put: 784018af9beSChristophe JAILLET xudma_rflow_put(rx_chn->common.udmax, flow->udma_rflow); 785018af9beSChristophe JAILLET flow->udma_rflow = NULL; 786018af9beSChristophe JAILLET 787d7024191SGrygorii Strashko return ret; 788d7024191SGrygorii Strashko } 789d7024191SGrygorii Strashko 790d7024191SGrygorii Strashko static void k3_udma_glue_dump_rx_chn(struct k3_udma_glue_rx_channel *chn) 791d7024191SGrygorii Strashko { 792d7024191SGrygorii Strashko struct device *dev = chn->common.dev; 793d7024191SGrygorii Strashko 794d7024191SGrygorii Strashko dev_dbg(dev, "dump_rx_chn:\n" 795d7024191SGrygorii Strashko "udma_rchan_id: %d\n" 796d7024191SGrygorii Strashko "src_thread: %08x\n" 797d7024191SGrygorii Strashko "dst_thread: %08x\n" 798d7024191SGrygorii Strashko "epib: %d\n" 799d7024191SGrygorii Strashko "hdesc_size: %u\n" 800d7024191SGrygorii Strashko "psdata_size: %u\n" 801d7024191SGrygorii Strashko "swdata_size: %u\n" 802d7024191SGrygorii Strashko "flow_id_base: %d\n" 803d7024191SGrygorii Strashko "flow_num: %d\n", 804d7024191SGrygorii Strashko chn->udma_rchan_id, 805d7024191SGrygorii Strashko chn->common.src_thread, 806d7024191SGrygorii Strashko chn->common.dst_thread, 807d7024191SGrygorii Strashko chn->common.epib, 808d7024191SGrygorii Strashko chn->common.hdesc_size, 809d7024191SGrygorii Strashko chn->common.psdata_size, 810d7024191SGrygorii Strashko chn->common.swdata_size, 811d7024191SGrygorii Strashko chn->flow_id_base, 812d7024191SGrygorii Strashko chn->flow_num); 813d7024191SGrygorii Strashko } 814d7024191SGrygorii Strashko 815d7024191SGrygorii Strashko static void k3_udma_glue_dump_rx_rt_chn(struct k3_udma_glue_rx_channel *chn, 816d7024191SGrygorii Strashko char *mark) 817d7024191SGrygorii Strashko { 818d7024191SGrygorii Strashko struct device *dev = chn->common.dev; 819d7024191SGrygorii Strashko 820d7024191SGrygorii Strashko dev_dbg(dev, "=== dump ===> %s\n", mark); 821d7024191SGrygorii Strashko 822bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_CTL_REG, 823bc7e5523SPeter Ujfalusi xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG)); 824bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PEER_RT_EN_REG, 825d7024191SGrygorii Strashko xudma_rchanrt_read(chn->udma_rchanx, 826bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_PEER_RT_EN_REG)); 827bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_PCNT_REG, 828bc7e5523SPeter Ujfalusi xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_PCNT_REG)); 829bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_BCNT_REG, 830bc7e5523SPeter Ujfalusi xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_BCNT_REG)); 831bc7e5523SPeter Ujfalusi dev_dbg(dev, "0x%08X: %08X\n", UDMA_CHAN_RT_SBCNT_REG, 832bc7e5523SPeter Ujfalusi xudma_rchanrt_read(chn->udma_rchanx, UDMA_CHAN_RT_SBCNT_REG)); 833d7024191SGrygorii Strashko } 834d7024191SGrygorii Strashko 835d7024191SGrygorii Strashko static int 836d7024191SGrygorii Strashko k3_udma_glue_allocate_rx_flows(struct k3_udma_glue_rx_channel *rx_chn, 837d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel_cfg *cfg) 838d7024191SGrygorii Strashko { 839d7024191SGrygorii Strashko int ret; 840d7024191SGrygorii Strashko 841d7024191SGrygorii Strashko /* default rflow */ 842d7024191SGrygorii Strashko if (cfg->flow_id_use_rxchan_id) 843d7024191SGrygorii Strashko return 0; 844d7024191SGrygorii Strashko 845d7024191SGrygorii Strashko /* not a GP rflows */ 846d7024191SGrygorii Strashko if (rx_chn->flow_id_base != -1 && 847d7024191SGrygorii Strashko !xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base)) 848d7024191SGrygorii Strashko return 0; 849d7024191SGrygorii Strashko 850d7024191SGrygorii Strashko /* Allocate range of GP rflows */ 851d7024191SGrygorii Strashko ret = xudma_alloc_gp_rflow_range(rx_chn->common.udmax, 852d7024191SGrygorii Strashko rx_chn->flow_id_base, 853d7024191SGrygorii Strashko rx_chn->flow_num); 854d7024191SGrygorii Strashko if (ret < 0) { 855d7024191SGrygorii Strashko dev_err(rx_chn->common.dev, "UDMAX reserve_rflow %d cnt:%d err: %d\n", 856d7024191SGrygorii Strashko rx_chn->flow_id_base, rx_chn->flow_num, ret); 857d7024191SGrygorii Strashko return ret; 858d7024191SGrygorii Strashko } 859d7024191SGrygorii Strashko rx_chn->flow_id_base = ret; 860d7024191SGrygorii Strashko 861d7024191SGrygorii Strashko return 0; 862d7024191SGrygorii Strashko } 863d7024191SGrygorii Strashko 864d7024191SGrygorii Strashko static struct k3_udma_glue_rx_channel * 865d7024191SGrygorii Strashko k3_udma_glue_request_rx_chn_priv(struct device *dev, const char *name, 866d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel_cfg *cfg) 867d7024191SGrygorii Strashko { 868d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel *rx_chn; 8695b65781dSVignesh Raghavendra struct psil_endpoint_config *ep_cfg; 870d7024191SGrygorii Strashko int ret, i; 871d7024191SGrygorii Strashko 872d7024191SGrygorii Strashko if (cfg->flow_id_num <= 0) 873d7024191SGrygorii Strashko return ERR_PTR(-EINVAL); 874d7024191SGrygorii Strashko 875d7024191SGrygorii Strashko if (cfg->flow_id_num != 1 && 876d7024191SGrygorii Strashko (cfg->def_flow_cfg || cfg->flow_id_use_rxchan_id)) 877d7024191SGrygorii Strashko return ERR_PTR(-EINVAL); 878d7024191SGrygorii Strashko 879d7024191SGrygorii Strashko rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL); 880d7024191SGrygorii Strashko if (!rx_chn) 881d7024191SGrygorii Strashko return ERR_PTR(-ENOMEM); 882d7024191SGrygorii Strashko 883d7024191SGrygorii Strashko rx_chn->common.dev = dev; 884d7024191SGrygorii Strashko rx_chn->common.swdata_size = cfg->swdata_size; 885d7024191SGrygorii Strashko rx_chn->remote = false; 886d7024191SGrygorii Strashko 887d7024191SGrygorii Strashko /* parse of udmap channel */ 888d7024191SGrygorii Strashko ret = of_k3_udma_glue_parse_chn(dev->of_node, name, 889d7024191SGrygorii Strashko &rx_chn->common, false); 890d7024191SGrygorii Strashko if (ret) 891d7024191SGrygorii Strashko goto err; 892d7024191SGrygorii Strashko 893d7024191SGrygorii Strashko rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib, 894d7024191SGrygorii Strashko rx_chn->common.psdata_size, 895d7024191SGrygorii Strashko rx_chn->common.swdata_size); 896d7024191SGrygorii Strashko 8975b65781dSVignesh Raghavendra ep_cfg = rx_chn->common.ep_config; 8985b65781dSVignesh Raghavendra 8995b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) 9005b65781dSVignesh Raghavendra rx_chn->udma_rchan_id = ep_cfg->mapped_channel_id; 9015b65781dSVignesh Raghavendra else 9025b65781dSVignesh Raghavendra rx_chn->udma_rchan_id = -1; 9035b65781dSVignesh Raghavendra 904d7024191SGrygorii Strashko /* request and cfg UDMAP RX channel */ 9055b65781dSVignesh Raghavendra rx_chn->udma_rchanx = xudma_rchan_get(rx_chn->common.udmax, 9065b65781dSVignesh Raghavendra rx_chn->udma_rchan_id); 907d7024191SGrygorii Strashko if (IS_ERR(rx_chn->udma_rchanx)) { 908d7024191SGrygorii Strashko ret = PTR_ERR(rx_chn->udma_rchanx); 909d7024191SGrygorii Strashko dev_err(dev, "UDMAX rchanx get err %d\n", ret); 910d7024191SGrygorii Strashko goto err; 911d7024191SGrygorii Strashko } 912d7024191SGrygorii Strashko rx_chn->udma_rchan_id = xudma_rchan_get_id(rx_chn->udma_rchanx); 913d7024191SGrygorii Strashko 9145b65781dSVignesh Raghavendra rx_chn->common.chan_dev.class = &k3_udma_glue_devclass; 9155b65781dSVignesh Raghavendra rx_chn->common.chan_dev.parent = xudma_get_device(rx_chn->common.udmax); 9165b65781dSVignesh Raghavendra dev_set_name(&rx_chn->common.chan_dev, "rchan%d-0x%04x", 9175b65781dSVignesh Raghavendra rx_chn->udma_rchan_id, rx_chn->common.src_thread); 9185b65781dSVignesh Raghavendra ret = device_register(&rx_chn->common.chan_dev); 9195b65781dSVignesh Raghavendra if (ret) { 9205b65781dSVignesh Raghavendra dev_err(dev, "Channel Device registration failed %d\n", ret); 921*ac2b9f34SYang Yingliang put_device(&rx_chn->common.chan_dev); 9225b65781dSVignesh Raghavendra rx_chn->common.chan_dev.parent = NULL; 9235b65781dSVignesh Raghavendra goto err; 9245b65781dSVignesh Raghavendra } 9255b65781dSVignesh Raghavendra 9265b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) { 9275b65781dSVignesh Raghavendra /* prepare the channel device as coherent */ 9285b65781dSVignesh Raghavendra rx_chn->common.chan_dev.dma_coherent = true; 9295b65781dSVignesh Raghavendra dma_coerce_mask_and_coherent(&rx_chn->common.chan_dev, 9305b65781dSVignesh Raghavendra DMA_BIT_MASK(48)); 9315b65781dSVignesh Raghavendra } 9325b65781dSVignesh Raghavendra 9335b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) { 9345b65781dSVignesh Raghavendra int flow_start = cfg->flow_id_base; 9355b65781dSVignesh Raghavendra int flow_end; 9365b65781dSVignesh Raghavendra 9375b65781dSVignesh Raghavendra if (flow_start == -1) 9385b65781dSVignesh Raghavendra flow_start = ep_cfg->flow_start; 9395b65781dSVignesh Raghavendra 9405b65781dSVignesh Raghavendra flow_end = flow_start + cfg->flow_id_num - 1; 9415b65781dSVignesh Raghavendra if (flow_start < ep_cfg->flow_start || 9425b65781dSVignesh Raghavendra flow_end > (ep_cfg->flow_start + ep_cfg->flow_num - 1)) { 9435b65781dSVignesh Raghavendra dev_err(dev, "Invalid flow range requested\n"); 9445b65781dSVignesh Raghavendra ret = -EINVAL; 9455b65781dSVignesh Raghavendra goto err; 9465b65781dSVignesh Raghavendra } 9475b65781dSVignesh Raghavendra rx_chn->flow_id_base = flow_start; 9485b65781dSVignesh Raghavendra } else { 949d7024191SGrygorii Strashko rx_chn->flow_id_base = cfg->flow_id_base; 950d7024191SGrygorii Strashko 951d7024191SGrygorii Strashko /* Use RX channel id as flow id: target dev can't generate flow_id */ 952d7024191SGrygorii Strashko if (cfg->flow_id_use_rxchan_id) 953d7024191SGrygorii Strashko rx_chn->flow_id_base = rx_chn->udma_rchan_id; 9545b65781dSVignesh Raghavendra } 9555b65781dSVignesh Raghavendra 9565b65781dSVignesh Raghavendra rx_chn->flow_num = cfg->flow_id_num; 957d7024191SGrygorii Strashko 958d7024191SGrygorii Strashko rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num, 959d7024191SGrygorii Strashko sizeof(*rx_chn->flows), GFP_KERNEL); 960d7024191SGrygorii Strashko if (!rx_chn->flows) { 961d7024191SGrygorii Strashko ret = -ENOMEM; 962d7024191SGrygorii Strashko goto err; 963d7024191SGrygorii Strashko } 964d7024191SGrygorii Strashko 965d7024191SGrygorii Strashko ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg); 966d7024191SGrygorii Strashko if (ret) 967d7024191SGrygorii Strashko goto err; 968d7024191SGrygorii Strashko 969d7024191SGrygorii Strashko for (i = 0; i < rx_chn->flow_num; i++) 970d7024191SGrygorii Strashko rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i; 971d7024191SGrygorii Strashko 972d7024191SGrygorii Strashko /* request and cfg psi-l */ 973d7024191SGrygorii Strashko rx_chn->common.dst_thread = 974d7024191SGrygorii Strashko xudma_dev_get_psil_base(rx_chn->common.udmax) + 975d7024191SGrygorii Strashko rx_chn->udma_rchan_id; 976d7024191SGrygorii Strashko 977d7024191SGrygorii Strashko ret = k3_udma_glue_cfg_rx_chn(rx_chn); 978d7024191SGrygorii Strashko if (ret) { 979d7024191SGrygorii Strashko dev_err(dev, "Failed to cfg rchan %d\n", ret); 980d7024191SGrygorii Strashko goto err; 981d7024191SGrygorii Strashko } 982d7024191SGrygorii Strashko 983d7024191SGrygorii Strashko /* init default RX flow only if flow_num = 1 */ 984d7024191SGrygorii Strashko if (cfg->def_flow_cfg) { 985d7024191SGrygorii Strashko ret = k3_udma_glue_cfg_rx_flow(rx_chn, 0, cfg->def_flow_cfg); 986d7024191SGrygorii Strashko if (ret) 987d7024191SGrygorii Strashko goto err; 988d7024191SGrygorii Strashko } 989d7024191SGrygorii Strashko 990d7024191SGrygorii Strashko k3_udma_glue_dump_rx_chn(rx_chn); 991d7024191SGrygorii Strashko 992d7024191SGrygorii Strashko return rx_chn; 993d7024191SGrygorii Strashko 994d7024191SGrygorii Strashko err: 995d7024191SGrygorii Strashko k3_udma_glue_release_rx_chn(rx_chn); 996d7024191SGrygorii Strashko return ERR_PTR(ret); 997d7024191SGrygorii Strashko } 998d7024191SGrygorii Strashko 999d7024191SGrygorii Strashko static struct k3_udma_glue_rx_channel * 1000d7024191SGrygorii Strashko k3_udma_glue_request_remote_rx_chn(struct device *dev, const char *name, 1001d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel_cfg *cfg) 1002d7024191SGrygorii Strashko { 1003d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel *rx_chn; 1004d7024191SGrygorii Strashko int ret, i; 1005d7024191SGrygorii Strashko 1006d7024191SGrygorii Strashko if (cfg->flow_id_num <= 0 || 1007d7024191SGrygorii Strashko cfg->flow_id_use_rxchan_id || 1008d7024191SGrygorii Strashko cfg->def_flow_cfg || 1009d7024191SGrygorii Strashko cfg->flow_id_base < 0) 1010d7024191SGrygorii Strashko return ERR_PTR(-EINVAL); 1011d7024191SGrygorii Strashko 1012d7024191SGrygorii Strashko /* 1013d7024191SGrygorii Strashko * Remote RX channel is under control of Remote CPU core, so 1014d7024191SGrygorii Strashko * Linux can only request and manipulate by dedicated RX flows 1015d7024191SGrygorii Strashko */ 1016d7024191SGrygorii Strashko 1017d7024191SGrygorii Strashko rx_chn = devm_kzalloc(dev, sizeof(*rx_chn), GFP_KERNEL); 1018d7024191SGrygorii Strashko if (!rx_chn) 1019d7024191SGrygorii Strashko return ERR_PTR(-ENOMEM); 1020d7024191SGrygorii Strashko 1021d7024191SGrygorii Strashko rx_chn->common.dev = dev; 1022d7024191SGrygorii Strashko rx_chn->common.swdata_size = cfg->swdata_size; 1023d7024191SGrygorii Strashko rx_chn->remote = true; 1024d7024191SGrygorii Strashko rx_chn->udma_rchan_id = -1; 1025d7024191SGrygorii Strashko rx_chn->flow_num = cfg->flow_id_num; 1026d7024191SGrygorii Strashko rx_chn->flow_id_base = cfg->flow_id_base; 1027d7024191SGrygorii Strashko rx_chn->psil_paired = false; 1028d7024191SGrygorii Strashko 1029d7024191SGrygorii Strashko /* parse of udmap channel */ 1030d7024191SGrygorii Strashko ret = of_k3_udma_glue_parse_chn(dev->of_node, name, 1031d7024191SGrygorii Strashko &rx_chn->common, false); 1032d7024191SGrygorii Strashko if (ret) 1033d7024191SGrygorii Strashko goto err; 1034d7024191SGrygorii Strashko 1035d7024191SGrygorii Strashko rx_chn->common.hdesc_size = cppi5_hdesc_calc_size(rx_chn->common.epib, 1036d7024191SGrygorii Strashko rx_chn->common.psdata_size, 1037d7024191SGrygorii Strashko rx_chn->common.swdata_size); 1038d7024191SGrygorii Strashko 1039d7024191SGrygorii Strashko rx_chn->flows = devm_kcalloc(dev, rx_chn->flow_num, 1040d7024191SGrygorii Strashko sizeof(*rx_chn->flows), GFP_KERNEL); 1041d7024191SGrygorii Strashko if (!rx_chn->flows) { 1042d7024191SGrygorii Strashko ret = -ENOMEM; 1043d7024191SGrygorii Strashko goto err; 1044d7024191SGrygorii Strashko } 1045d7024191SGrygorii Strashko 10465b65781dSVignesh Raghavendra rx_chn->common.chan_dev.class = &k3_udma_glue_devclass; 10475b65781dSVignesh Raghavendra rx_chn->common.chan_dev.parent = xudma_get_device(rx_chn->common.udmax); 10485b65781dSVignesh Raghavendra dev_set_name(&rx_chn->common.chan_dev, "rchan_remote-0x%04x", 10495b65781dSVignesh Raghavendra rx_chn->common.src_thread); 10505b65781dSVignesh Raghavendra ret = device_register(&rx_chn->common.chan_dev); 10515b65781dSVignesh Raghavendra if (ret) { 10525b65781dSVignesh Raghavendra dev_err(dev, "Channel Device registration failed %d\n", ret); 1053*ac2b9f34SYang Yingliang put_device(&rx_chn->common.chan_dev); 10545b65781dSVignesh Raghavendra rx_chn->common.chan_dev.parent = NULL; 10555b65781dSVignesh Raghavendra goto err; 10565b65781dSVignesh Raghavendra } 10575b65781dSVignesh Raghavendra 10585b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) { 10595b65781dSVignesh Raghavendra /* prepare the channel device as coherent */ 10605b65781dSVignesh Raghavendra rx_chn->common.chan_dev.dma_coherent = true; 10615b65781dSVignesh Raghavendra dma_coerce_mask_and_coherent(&rx_chn->common.chan_dev, 10625b65781dSVignesh Raghavendra DMA_BIT_MASK(48)); 10635b65781dSVignesh Raghavendra } 10645b65781dSVignesh Raghavendra 1065d7024191SGrygorii Strashko ret = k3_udma_glue_allocate_rx_flows(rx_chn, cfg); 1066d7024191SGrygorii Strashko if (ret) 1067d7024191SGrygorii Strashko goto err; 1068d7024191SGrygorii Strashko 1069d7024191SGrygorii Strashko for (i = 0; i < rx_chn->flow_num; i++) 1070d7024191SGrygorii Strashko rx_chn->flows[i].udma_rflow_id = rx_chn->flow_id_base + i; 1071d7024191SGrygorii Strashko 1072d7024191SGrygorii Strashko k3_udma_glue_dump_rx_chn(rx_chn); 1073d7024191SGrygorii Strashko 1074d7024191SGrygorii Strashko return rx_chn; 1075d7024191SGrygorii Strashko 1076d7024191SGrygorii Strashko err: 1077d7024191SGrygorii Strashko k3_udma_glue_release_rx_chn(rx_chn); 1078d7024191SGrygorii Strashko return ERR_PTR(ret); 1079d7024191SGrygorii Strashko } 1080d7024191SGrygorii Strashko 1081d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel * 1082d7024191SGrygorii Strashko k3_udma_glue_request_rx_chn(struct device *dev, const char *name, 1083d7024191SGrygorii Strashko struct k3_udma_glue_rx_channel_cfg *cfg) 1084d7024191SGrygorii Strashko { 1085d7024191SGrygorii Strashko if (cfg->remote) 1086d7024191SGrygorii Strashko return k3_udma_glue_request_remote_rx_chn(dev, name, cfg); 1087d7024191SGrygorii Strashko else 1088d7024191SGrygorii Strashko return k3_udma_glue_request_rx_chn_priv(dev, name, cfg); 1089d7024191SGrygorii Strashko } 1090d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_request_rx_chn); 1091d7024191SGrygorii Strashko 1092d7024191SGrygorii Strashko void k3_udma_glue_release_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 1093d7024191SGrygorii Strashko { 1094d7024191SGrygorii Strashko int i; 1095d7024191SGrygorii Strashko 1096d7024191SGrygorii Strashko if (IS_ERR_OR_NULL(rx_chn->common.udmax)) 1097d7024191SGrygorii Strashko return; 1098d7024191SGrygorii Strashko 1099d7024191SGrygorii Strashko if (rx_chn->psil_paired) { 1100d7024191SGrygorii Strashko xudma_navss_psil_unpair(rx_chn->common.udmax, 1101d7024191SGrygorii Strashko rx_chn->common.src_thread, 1102d7024191SGrygorii Strashko rx_chn->common.dst_thread); 1103d7024191SGrygorii Strashko rx_chn->psil_paired = false; 1104d7024191SGrygorii Strashko } 1105d7024191SGrygorii Strashko 1106d7024191SGrygorii Strashko for (i = 0; i < rx_chn->flow_num; i++) 1107d7024191SGrygorii Strashko k3_udma_glue_release_rx_flow(rx_chn, i); 1108d7024191SGrygorii Strashko 1109d7024191SGrygorii Strashko if (xudma_rflow_is_gp(rx_chn->common.udmax, rx_chn->flow_id_base)) 1110d7024191SGrygorii Strashko xudma_free_gp_rflow_range(rx_chn->common.udmax, 1111d7024191SGrygorii Strashko rx_chn->flow_id_base, 1112d7024191SGrygorii Strashko rx_chn->flow_num); 1113d7024191SGrygorii Strashko 1114d7024191SGrygorii Strashko if (!IS_ERR_OR_NULL(rx_chn->udma_rchanx)) 1115d7024191SGrygorii Strashko xudma_rchan_put(rx_chn->common.udmax, 1116d7024191SGrygorii Strashko rx_chn->udma_rchanx); 11175b65781dSVignesh Raghavendra 11185b65781dSVignesh Raghavendra if (rx_chn->common.chan_dev.parent) { 11195b65781dSVignesh Raghavendra device_unregister(&rx_chn->common.chan_dev); 11205b65781dSVignesh Raghavendra rx_chn->common.chan_dev.parent = NULL; 11215b65781dSVignesh Raghavendra } 1122d7024191SGrygorii Strashko } 1123d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_release_rx_chn); 1124d7024191SGrygorii Strashko 1125d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_init(struct k3_udma_glue_rx_channel *rx_chn, 1126d7024191SGrygorii Strashko u32 flow_idx, 1127d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow_cfg *flow_cfg) 1128d7024191SGrygorii Strashko { 1129d7024191SGrygorii Strashko if (flow_idx >= rx_chn->flow_num) 1130d7024191SGrygorii Strashko return -EINVAL; 1131d7024191SGrygorii Strashko 1132d7024191SGrygorii Strashko return k3_udma_glue_cfg_rx_flow(rx_chn, flow_idx, flow_cfg); 1133d7024191SGrygorii Strashko } 1134d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_init); 1135d7024191SGrygorii Strashko 1136d7024191SGrygorii Strashko u32 k3_udma_glue_rx_flow_get_fdq_id(struct k3_udma_glue_rx_channel *rx_chn, 1137d7024191SGrygorii Strashko u32 flow_idx) 1138d7024191SGrygorii Strashko { 1139d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow; 1140d7024191SGrygorii Strashko 1141d7024191SGrygorii Strashko if (flow_idx >= rx_chn->flow_num) 1142d7024191SGrygorii Strashko return -EINVAL; 1143d7024191SGrygorii Strashko 1144d7024191SGrygorii Strashko flow = &rx_chn->flows[flow_idx]; 1145d7024191SGrygorii Strashko 1146d7024191SGrygorii Strashko return k3_ringacc_get_ring_id(flow->ringrxfdq); 1147d7024191SGrygorii Strashko } 1148d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_get_fdq_id); 1149d7024191SGrygorii Strashko 1150d7024191SGrygorii Strashko u32 k3_udma_glue_rx_get_flow_id_base(struct k3_udma_glue_rx_channel *rx_chn) 1151d7024191SGrygorii Strashko { 1152d7024191SGrygorii Strashko return rx_chn->flow_id_base; 1153d7024191SGrygorii Strashko } 1154d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_flow_id_base); 1155d7024191SGrygorii Strashko 1156d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_enable(struct k3_udma_glue_rx_channel *rx_chn, 1157d7024191SGrygorii Strashko u32 flow_idx) 1158d7024191SGrygorii Strashko { 1159d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx]; 1160d7024191SGrygorii Strashko const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 1161d7024191SGrygorii Strashko struct device *dev = rx_chn->common.dev; 1162d7024191SGrygorii Strashko struct ti_sci_msg_rm_udmap_flow_cfg req; 1163d7024191SGrygorii Strashko int rx_ring_id; 1164d7024191SGrygorii Strashko int rx_ringfdq_id; 1165d7024191SGrygorii Strashko int ret = 0; 1166d7024191SGrygorii Strashko 1167d7024191SGrygorii Strashko if (!rx_chn->remote) 1168d7024191SGrygorii Strashko return -EINVAL; 1169d7024191SGrygorii Strashko 1170d7024191SGrygorii Strashko rx_ring_id = k3_ringacc_get_ring_id(flow->ringrx); 1171d7024191SGrygorii Strashko rx_ringfdq_id = k3_ringacc_get_ring_id(flow->ringrxfdq); 1172d7024191SGrygorii Strashko 1173d7024191SGrygorii Strashko memset(&req, 0, sizeof(req)); 1174d7024191SGrygorii Strashko 1175d7024191SGrygorii Strashko req.valid_params = 1176d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID | 1177d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID | 1178d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID | 1179d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID | 1180d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID; 1181d7024191SGrygorii Strashko req.nav_id = tisci_rm->tisci_dev_id; 1182d7024191SGrygorii Strashko req.flow_index = flow->udma_rflow_id; 1183d7024191SGrygorii Strashko req.rx_dest_qnum = rx_ring_id; 1184d7024191SGrygorii Strashko req.rx_fdq0_sz0_qnum = rx_ringfdq_id; 1185d7024191SGrygorii Strashko req.rx_fdq1_qnum = rx_ringfdq_id; 1186d7024191SGrygorii Strashko req.rx_fdq2_qnum = rx_ringfdq_id; 1187d7024191SGrygorii Strashko req.rx_fdq3_qnum = rx_ringfdq_id; 1188d7024191SGrygorii Strashko 1189d7024191SGrygorii Strashko ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req); 1190d7024191SGrygorii Strashko if (ret) { 1191d7024191SGrygorii Strashko dev_err(dev, "flow%d enable failed: %d\n", flow->udma_rflow_id, 1192d7024191SGrygorii Strashko ret); 1193d7024191SGrygorii Strashko } 1194d7024191SGrygorii Strashko 1195d7024191SGrygorii Strashko return ret; 1196d7024191SGrygorii Strashko } 1197d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_enable); 1198d7024191SGrygorii Strashko 1199d7024191SGrygorii Strashko int k3_udma_glue_rx_flow_disable(struct k3_udma_glue_rx_channel *rx_chn, 1200d7024191SGrygorii Strashko u32 flow_idx) 1201d7024191SGrygorii Strashko { 1202d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_idx]; 1203d7024191SGrygorii Strashko const struct udma_tisci_rm *tisci_rm = rx_chn->common.tisci_rm; 1204d7024191SGrygorii Strashko struct device *dev = rx_chn->common.dev; 1205d7024191SGrygorii Strashko struct ti_sci_msg_rm_udmap_flow_cfg req; 1206d7024191SGrygorii Strashko int ret = 0; 1207d7024191SGrygorii Strashko 1208d7024191SGrygorii Strashko if (!rx_chn->remote) 1209d7024191SGrygorii Strashko return -EINVAL; 1210d7024191SGrygorii Strashko 1211d7024191SGrygorii Strashko memset(&req, 0, sizeof(req)); 1212d7024191SGrygorii Strashko req.valid_params = 1213d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_DEST_QNUM_VALID | 1214d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ0_SZ0_QNUM_VALID | 1215d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ1_QNUM_VALID | 1216d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ2_QNUM_VALID | 1217d7024191SGrygorii Strashko TI_SCI_MSG_VALUE_RM_UDMAP_FLOW_FDQ3_QNUM_VALID; 1218d7024191SGrygorii Strashko req.nav_id = tisci_rm->tisci_dev_id; 1219d7024191SGrygorii Strashko req.flow_index = flow->udma_rflow_id; 1220d7024191SGrygorii Strashko req.rx_dest_qnum = TI_SCI_RESOURCE_NULL; 1221d7024191SGrygorii Strashko req.rx_fdq0_sz0_qnum = TI_SCI_RESOURCE_NULL; 1222d7024191SGrygorii Strashko req.rx_fdq1_qnum = TI_SCI_RESOURCE_NULL; 1223d7024191SGrygorii Strashko req.rx_fdq2_qnum = TI_SCI_RESOURCE_NULL; 1224d7024191SGrygorii Strashko req.rx_fdq3_qnum = TI_SCI_RESOURCE_NULL; 1225d7024191SGrygorii Strashko 1226d7024191SGrygorii Strashko ret = tisci_rm->tisci_udmap_ops->rx_flow_cfg(tisci_rm->tisci, &req); 1227d7024191SGrygorii Strashko if (ret) { 1228d7024191SGrygorii Strashko dev_err(dev, "flow%d disable failed: %d\n", flow->udma_rflow_id, 1229d7024191SGrygorii Strashko ret); 1230d7024191SGrygorii Strashko } 1231d7024191SGrygorii Strashko 1232d7024191SGrygorii Strashko return ret; 1233d7024191SGrygorii Strashko } 1234d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_flow_disable); 1235d7024191SGrygorii Strashko 1236d7024191SGrygorii Strashko int k3_udma_glue_enable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 1237d7024191SGrygorii Strashko { 123869973b48SGrygorii Strashko int ret; 123969973b48SGrygorii Strashko 1240d7024191SGrygorii Strashko if (rx_chn->remote) 1241d7024191SGrygorii Strashko return -EINVAL; 1242d7024191SGrygorii Strashko 1243d7024191SGrygorii Strashko if (rx_chn->flows_ready < rx_chn->flow_num) 1244d7024191SGrygorii Strashko return -EINVAL; 1245d7024191SGrygorii Strashko 124669973b48SGrygorii Strashko ret = xudma_navss_psil_pair(rx_chn->common.udmax, 124769973b48SGrygorii Strashko rx_chn->common.src_thread, 124869973b48SGrygorii Strashko rx_chn->common.dst_thread); 124969973b48SGrygorii Strashko if (ret) { 125069973b48SGrygorii Strashko dev_err(rx_chn->common.dev, "PSI-L request err %d\n", ret); 125169973b48SGrygorii Strashko return ret; 125269973b48SGrygorii Strashko } 125369973b48SGrygorii Strashko 125469973b48SGrygorii Strashko rx_chn->psil_paired = true; 125569973b48SGrygorii Strashko 1256bc7e5523SPeter Ujfalusi xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG, 125752c74d3dSGrygorii Strashko UDMA_CHAN_RT_CTL_EN); 1258d7024191SGrygorii Strashko 1259bc7e5523SPeter Ujfalusi xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG, 1260d7024191SGrygorii Strashko UDMA_PEER_RT_EN_ENABLE); 1261d7024191SGrygorii Strashko 1262d7024191SGrygorii Strashko k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt en"); 1263d7024191SGrygorii Strashko return 0; 1264d7024191SGrygorii Strashko } 1265d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_enable_rx_chn); 1266d7024191SGrygorii Strashko 1267d7024191SGrygorii Strashko void k3_udma_glue_disable_rx_chn(struct k3_udma_glue_rx_channel *rx_chn) 1268d7024191SGrygorii Strashko { 1269d7024191SGrygorii Strashko k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis1"); 1270d7024191SGrygorii Strashko 1271d7024191SGrygorii Strashko xudma_rchanrt_write(rx_chn->udma_rchanx, 1272bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_PEER_RT_EN_REG, 0); 1273bc7e5523SPeter Ujfalusi xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG, 0); 1274d7024191SGrygorii Strashko 1275d7024191SGrygorii Strashko k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt dis2"); 127669973b48SGrygorii Strashko 127769973b48SGrygorii Strashko if (rx_chn->psil_paired) { 127869973b48SGrygorii Strashko xudma_navss_psil_unpair(rx_chn->common.udmax, 127969973b48SGrygorii Strashko rx_chn->common.src_thread, 128069973b48SGrygorii Strashko rx_chn->common.dst_thread); 128169973b48SGrygorii Strashko rx_chn->psil_paired = false; 128269973b48SGrygorii Strashko } 1283d7024191SGrygorii Strashko } 1284d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_disable_rx_chn); 1285d7024191SGrygorii Strashko 1286d7024191SGrygorii Strashko void k3_udma_glue_tdown_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 1287d7024191SGrygorii Strashko bool sync) 1288d7024191SGrygorii Strashko { 1289d7024191SGrygorii Strashko int i = 0; 1290d7024191SGrygorii Strashko u32 val; 1291d7024191SGrygorii Strashko 1292d7024191SGrygorii Strashko if (rx_chn->remote) 1293d7024191SGrygorii Strashko return; 1294d7024191SGrygorii Strashko 1295d7024191SGrygorii Strashko k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown1"); 1296d7024191SGrygorii Strashko 1297bc7e5523SPeter Ujfalusi xudma_rchanrt_write(rx_chn->udma_rchanx, UDMA_CHAN_RT_PEER_RT_EN_REG, 1298d7024191SGrygorii Strashko UDMA_PEER_RT_EN_ENABLE | UDMA_PEER_RT_EN_TEARDOWN); 1299d7024191SGrygorii Strashko 1300bc7e5523SPeter Ujfalusi val = xudma_rchanrt_read(rx_chn->udma_rchanx, UDMA_CHAN_RT_CTL_REG); 1301d7024191SGrygorii Strashko 1302d7024191SGrygorii Strashko while (sync && (val & UDMA_CHAN_RT_CTL_EN)) { 1303d7024191SGrygorii Strashko val = xudma_rchanrt_read(rx_chn->udma_rchanx, 1304bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_CTL_REG); 1305d7024191SGrygorii Strashko udelay(1); 1306d7024191SGrygorii Strashko if (i > K3_UDMAX_TDOWN_TIMEOUT_US) { 1307d7024191SGrygorii Strashko dev_err(rx_chn->common.dev, "RX tdown timeout\n"); 1308d7024191SGrygorii Strashko break; 1309d7024191SGrygorii Strashko } 1310d7024191SGrygorii Strashko i++; 1311d7024191SGrygorii Strashko } 1312d7024191SGrygorii Strashko 1313d7024191SGrygorii Strashko val = xudma_rchanrt_read(rx_chn->udma_rchanx, 1314bc7e5523SPeter Ujfalusi UDMA_CHAN_RT_PEER_RT_EN_REG); 1315d7024191SGrygorii Strashko if (sync && (val & UDMA_PEER_RT_EN_ENABLE)) 1316d7024191SGrygorii Strashko dev_err(rx_chn->common.dev, "TX tdown peer not stopped\n"); 1317d7024191SGrygorii Strashko k3_udma_glue_dump_rx_rt_chn(rx_chn, "rxrt tdown2"); 1318d7024191SGrygorii Strashko } 1319d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_tdown_rx_chn); 1320d7024191SGrygorii Strashko 1321d7024191SGrygorii Strashko void k3_udma_glue_reset_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 1322d7024191SGrygorii Strashko u32 flow_num, void *data, 1323d7024191SGrygorii Strashko void (*cleanup)(void *data, dma_addr_t desc_dma), bool skip_fdq) 1324d7024191SGrygorii Strashko { 1325d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 1326d7024191SGrygorii Strashko struct device *dev = rx_chn->common.dev; 1327d7024191SGrygorii Strashko dma_addr_t desc_dma; 1328d7024191SGrygorii Strashko int occ_rx, i, ret; 1329d7024191SGrygorii Strashko 1330d7024191SGrygorii Strashko /* reset RXCQ as it is not input for udma - expected to be empty */ 1331d7024191SGrygorii Strashko occ_rx = k3_ringacc_ring_get_occ(flow->ringrx); 1332d7024191SGrygorii Strashko dev_dbg(dev, "RX reset flow %u occ_rx %u\n", flow_num, occ_rx); 1333d7024191SGrygorii Strashko 1334d7024191SGrygorii Strashko /* Skip RX FDQ in case one FDQ is used for the set of flows */ 1335d7024191SGrygorii Strashko if (skip_fdq) 13365b65781dSVignesh Raghavendra goto do_reset; 1337d7024191SGrygorii Strashko 1338d7024191SGrygorii Strashko /* 1339d7024191SGrygorii Strashko * RX FDQ reset need to be special way as it is input for udma and its 1340d7024191SGrygorii Strashko * state cached by udma, so: 1341d7024191SGrygorii Strashko * 1) save RX FDQ occ 1342d7024191SGrygorii Strashko * 2) clean up RX FDQ and call callback .cleanup() for each desc 1343d7024191SGrygorii Strashko * 3) reset RX FDQ in a special way 1344d7024191SGrygorii Strashko */ 1345d7024191SGrygorii Strashko occ_rx = k3_ringacc_ring_get_occ(flow->ringrxfdq); 1346d7024191SGrygorii Strashko dev_dbg(dev, "RX reset flow %u occ_rx_fdq %u\n", flow_num, occ_rx); 1347d7024191SGrygorii Strashko 1348d7024191SGrygorii Strashko for (i = 0; i < occ_rx; i++) { 1349d7024191SGrygorii Strashko ret = k3_ringacc_ring_pop(flow->ringrxfdq, &desc_dma); 1350d7024191SGrygorii Strashko if (ret) { 13515b65781dSVignesh Raghavendra if (ret != -ENODATA) 1352d7024191SGrygorii Strashko dev_err(dev, "RX reset pop %d\n", ret); 1353d7024191SGrygorii Strashko break; 1354d7024191SGrygorii Strashko } 1355d7024191SGrygorii Strashko cleanup(data, desc_dma); 1356d7024191SGrygorii Strashko } 1357d7024191SGrygorii Strashko 1358d7024191SGrygorii Strashko k3_ringacc_ring_reset_dma(flow->ringrxfdq, occ_rx); 13595b65781dSVignesh Raghavendra 13605b65781dSVignesh Raghavendra do_reset: 13615b65781dSVignesh Raghavendra k3_ringacc_ring_reset(flow->ringrx); 1362d7024191SGrygorii Strashko } 1363d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_reset_rx_chn); 1364d7024191SGrygorii Strashko 1365d7024191SGrygorii Strashko int k3_udma_glue_push_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 1366d7024191SGrygorii Strashko u32 flow_num, struct cppi5_host_desc_t *desc_rx, 1367d7024191SGrygorii Strashko dma_addr_t desc_dma) 1368d7024191SGrygorii Strashko { 1369d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 1370d7024191SGrygorii Strashko 1371d7024191SGrygorii Strashko return k3_ringacc_ring_push(flow->ringrxfdq, &desc_dma); 1372d7024191SGrygorii Strashko } 1373d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_push_rx_chn); 1374d7024191SGrygorii Strashko 1375d7024191SGrygorii Strashko int k3_udma_glue_pop_rx_chn(struct k3_udma_glue_rx_channel *rx_chn, 1376d7024191SGrygorii Strashko u32 flow_num, dma_addr_t *desc_dma) 1377d7024191SGrygorii Strashko { 1378d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow = &rx_chn->flows[flow_num]; 1379d7024191SGrygorii Strashko 1380d7024191SGrygorii Strashko return k3_ringacc_ring_pop(flow->ringrx, desc_dma); 1381d7024191SGrygorii Strashko } 1382d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_pop_rx_chn); 1383d7024191SGrygorii Strashko 1384d7024191SGrygorii Strashko int k3_udma_glue_rx_get_irq(struct k3_udma_glue_rx_channel *rx_chn, 1385d7024191SGrygorii Strashko u32 flow_num) 1386d7024191SGrygorii Strashko { 1387d7024191SGrygorii Strashko struct k3_udma_glue_rx_flow *flow; 1388d7024191SGrygorii Strashko 1389d7024191SGrygorii Strashko flow = &rx_chn->flows[flow_num]; 1390d7024191SGrygorii Strashko 13915b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax)) { 13925b65781dSVignesh Raghavendra flow->virq = xudma_pktdma_rflow_get_irq(rx_chn->common.udmax, 13935b65781dSVignesh Raghavendra flow->udma_rflow_id); 13945b65781dSVignesh Raghavendra } else { 1395d7024191SGrygorii Strashko flow->virq = k3_ringacc_get_ring_irq_num(flow->ringrx); 13965b65781dSVignesh Raghavendra } 1397d7024191SGrygorii Strashko 1398d7024191SGrygorii Strashko return flow->virq; 1399d7024191SGrygorii Strashko } 1400d7024191SGrygorii Strashko EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_irq); 1401426506a7SPeter Ujfalusi 1402426506a7SPeter Ujfalusi struct device * 1403426506a7SPeter Ujfalusi k3_udma_glue_rx_get_dma_device(struct k3_udma_glue_rx_channel *rx_chn) 1404426506a7SPeter Ujfalusi { 14055b65781dSVignesh Raghavendra if (xudma_is_pktdma(rx_chn->common.udmax) && 14065b65781dSVignesh Raghavendra (rx_chn->common.atype_asel == 14 || rx_chn->common.atype_asel == 15)) 14075b65781dSVignesh Raghavendra return &rx_chn->common.chan_dev; 14085b65781dSVignesh Raghavendra 1409426506a7SPeter Ujfalusi return xudma_get_device(rx_chn->common.udmax); 1410426506a7SPeter Ujfalusi } 1411426506a7SPeter Ujfalusi EXPORT_SYMBOL_GPL(k3_udma_glue_rx_get_dma_device); 14125b65781dSVignesh Raghavendra 14135b65781dSVignesh Raghavendra void k3_udma_glue_rx_dma_to_cppi5_addr(struct k3_udma_glue_rx_channel *rx_chn, 14145b65781dSVignesh Raghavendra dma_addr_t *addr) 14155b65781dSVignesh Raghavendra { 14165b65781dSVignesh Raghavendra if (!xudma_is_pktdma(rx_chn->common.udmax) || 14175b65781dSVignesh Raghavendra !rx_chn->common.atype_asel) 14185b65781dSVignesh Raghavendra return; 14195b65781dSVignesh Raghavendra 14205b65781dSVignesh Raghavendra *addr |= (u64)rx_chn->common.atype_asel << K3_ADDRESS_ASEL_SHIFT; 14215b65781dSVignesh Raghavendra } 14225b65781dSVignesh Raghavendra EXPORT_SYMBOL_GPL(k3_udma_glue_rx_dma_to_cppi5_addr); 14235b65781dSVignesh Raghavendra 14245b65781dSVignesh Raghavendra void k3_udma_glue_rx_cppi5_to_dma_addr(struct k3_udma_glue_rx_channel *rx_chn, 14255b65781dSVignesh Raghavendra dma_addr_t *addr) 14265b65781dSVignesh Raghavendra { 14275b65781dSVignesh Raghavendra if (!xudma_is_pktdma(rx_chn->common.udmax) || 14285b65781dSVignesh Raghavendra !rx_chn->common.atype_asel) 14295b65781dSVignesh Raghavendra return; 14305b65781dSVignesh Raghavendra 14315b65781dSVignesh Raghavendra *addr &= (u64)GENMASK(K3_ADDRESS_ASEL_SHIFT - 1, 0); 14325b65781dSVignesh Raghavendra } 14335b65781dSVignesh Raghavendra EXPORT_SYMBOL_GPL(k3_udma_glue_rx_cppi5_to_dma_addr); 14345b65781dSVignesh Raghavendra 14355b65781dSVignesh Raghavendra static int __init k3_udma_glue_class_init(void) 14365b65781dSVignesh Raghavendra { 14375b65781dSVignesh Raghavendra return class_register(&k3_udma_glue_devclass); 14385b65781dSVignesh Raghavendra } 14395b65781dSVignesh Raghavendra arch_initcall(k3_udma_glue_class_init); 1440