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