Lines Matching refs:pl330
1179 static inline int _ldst_peripheral(struct pl330_dmac *pl330, in _ldst_peripheral() argument
1186 if (pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP) in _ldst_peripheral()
1193 if (!(pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP)) in _ldst_peripheral()
1206 static int _bursts(struct pl330_dmac *pl330, unsigned dry_run, u8 buf[], in _bursts() argument
1216 off += _ldst_peripheral(pl330, dry_run, &buf[off], pxs, cyc, in _bursts()
1237 static int _dregs(struct pl330_dmac *pl330, unsigned int dry_run, u8 buf[], in _dregs() argument
1250 off += _ldst_peripheral(pl330, dry_run, &buf[off], pxs, in _dregs()
1276 static inline int _loop(struct pl330_dmac *pl330, unsigned dry_run, u8 buf[], in _loop() argument
1284 return _bursts(pl330, dry_run, buf, pxs, 1); in _loop()
1302 szbrst = _bursts(pl330, 1, buf, pxs, 1); in _loop()
1334 off += _bursts(pl330, dry_run, &buf[off], pxs, cyc); in _loop()
1357 static inline int _setup_loops(struct pl330_dmac *pl330, in _setup_loops() argument
1370 off += _loop(pl330, dry_run, &buf[off], &c, pxs); in _setup_loops()
1373 off += _dregs(pl330, dry_run, &buf[off], pxs, num_dregs); in _setup_loops()
1378 static inline int _setup_xfer(struct pl330_dmac *pl330, in _setup_xfer() argument
1391 off += _setup_loops(pl330, dry_run, &buf[off], pxs); in _setup_xfer()
1400 static int _setup_req(struct pl330_dmac *pl330, unsigned dry_run, in _setup_req() argument
1413 off += _setup_xfer(pl330, dry_run, &buf[off], pxs); in _setup_req()
1463 struct pl330_dmac *pl330 = thrd->dmac; in pl330_submit_req() local
1484 if (pl330->state == DYING in pl330_submit_req()
1485 || pl330->dmac_tbd.reset_chan & (1 << thrd->id)) { in pl330_submit_req()
1493 desc->peri >= pl330->pcfg.num_peri) { in pl330_submit_req()
1500 spin_lock_irqsave(&pl330->lock, flags); in pl330_submit_req()
1521 ret = _setup_req(pl330, 1, thrd, idx, &xs); in pl330_submit_req()
1525 if (ret > pl330->mcbufsz / 2) { in pl330_submit_req()
1526 dev_info(pl330->ddma.dev, "%s:%d Try increasing mcbufsz (%i/%i)\n", in pl330_submit_req()
1527 __func__, __LINE__, ret, pl330->mcbufsz / 2); in pl330_submit_req()
1535 _setup_req(pl330, 0, thrd, idx, &xs); in pl330_submit_req()
1540 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_submit_req()
1570 struct pl330_dmac *pl330 = (struct pl330_dmac *) data; in pl330_dotask() local
1574 spin_lock_irqsave(&pl330->lock, flags); in pl330_dotask()
1577 if (pl330->dmac_tbd.reset_dmac) { in pl330_dotask()
1578 pl330->state = DYING; in pl330_dotask()
1580 pl330->dmac_tbd.reset_mngr = true; in pl330_dotask()
1582 pl330->dmac_tbd.reset_dmac = false; in pl330_dotask()
1585 if (pl330->dmac_tbd.reset_mngr) { in pl330_dotask()
1586 _stop(pl330->manager); in pl330_dotask()
1588 pl330->dmac_tbd.reset_chan = (1 << pl330->pcfg.num_chan) - 1; in pl330_dotask()
1590 pl330->dmac_tbd.reset_mngr = false; in pl330_dotask()
1593 for (i = 0; i < pl330->pcfg.num_chan; i++) { in pl330_dotask()
1595 if (pl330->dmac_tbd.reset_chan & (1 << i)) { in pl330_dotask()
1596 struct pl330_thread *thrd = &pl330->channels[i]; in pl330_dotask()
1597 void __iomem *regs = pl330->base; in pl330_dotask()
1607 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_dotask()
1610 spin_lock_irqsave(&pl330->lock, flags); in pl330_dotask()
1617 pl330->dmac_tbd.reset_chan &= ~(1 << i); in pl330_dotask()
1621 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_dotask()
1627 static int pl330_update(struct pl330_dmac *pl330) in pl330_update() argument
1635 regs = pl330->base; in pl330_update()
1637 spin_lock_irqsave(&pl330->lock, flags); in pl330_update()
1641 pl330->dmac_tbd.reset_mngr = true; in pl330_update()
1643 pl330->dmac_tbd.reset_mngr = false; in pl330_update()
1645 val = readl(regs + FSC) & ((1 << pl330->pcfg.num_chan) - 1); in pl330_update()
1646 pl330->dmac_tbd.reset_chan |= val; in pl330_update()
1649 while (i < pl330->pcfg.num_chan) { in pl330_update()
1651 dev_info(pl330->ddma.dev, in pl330_update()
1655 _stop(&pl330->channels[i]); in pl330_update()
1663 if (pl330->pcfg.num_events < 32 in pl330_update()
1664 && val & ~((1 << pl330->pcfg.num_events) - 1)) { in pl330_update()
1665 pl330->dmac_tbd.reset_dmac = true; in pl330_update()
1666 dev_err(pl330->ddma.dev, "%s:%d Unexpected!\n", __func__, in pl330_update()
1672 for (ev = 0; ev < pl330->pcfg.num_events; ev++) { in pl330_update()
1684 id = pl330->events[ev]; in pl330_update()
1686 thrd = &pl330->channels[id]; in pl330_update()
1702 list_add_tail(&descdone->rqd, &pl330->req_done); in pl330_update()
1707 while (!list_empty(&pl330->req_done)) { in pl330_update()
1708 descdone = list_first_entry(&pl330->req_done, in pl330_update()
1711 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_update()
1713 spin_lock_irqsave(&pl330->lock, flags); in pl330_update()
1717 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_update()
1719 if (pl330->dmac_tbd.reset_dmac in pl330_update()
1720 || pl330->dmac_tbd.reset_mngr in pl330_update()
1721 || pl330->dmac_tbd.reset_chan) { in pl330_update()
1723 tasklet_schedule(&pl330->tasks); in pl330_update()
1732 struct pl330_dmac *pl330 = thrd->dmac; in _alloc_event() local
1735 for (ev = 0; ev < pl330->pcfg.num_events; ev++) in _alloc_event()
1736 if (pl330->events[ev] == -1) { in _alloc_event()
1737 pl330->events[ev] = thrd->id; in _alloc_event()
1744 static bool _chan_ns(const struct pl330_dmac *pl330, int i) in _chan_ns() argument
1746 return pl330->pcfg.irq_ns & (1 << i); in _chan_ns()
1752 static struct pl330_thread *pl330_request_channel(struct pl330_dmac *pl330) in pl330_request_channel() argument
1757 if (pl330->state == DYING) in pl330_request_channel()
1760 chans = pl330->pcfg.num_chan; in pl330_request_channel()
1763 thrd = &pl330->channels[i]; in pl330_request_channel()
1765 _chan_ns(pl330, i))) { in pl330_request_channel()
1785 struct pl330_dmac *pl330 = thrd->dmac; in _free_event() local
1788 if (ev >= 0 && ev < pl330->pcfg.num_events in _free_event()
1789 && pl330->events[ev] == thrd->id) in _free_event()
1790 pl330->events[ev] = -1; in _free_event()
1810 static void read_dmac_config(struct pl330_dmac *pl330) in read_dmac_config() argument
1812 void __iomem *regs = pl330->base; in read_dmac_config()
1817 pl330->pcfg.data_bus_width = 8 * (1 << val); in read_dmac_config()
1821 pl330->pcfg.data_buf_dep = val + 1; in read_dmac_config()
1826 pl330->pcfg.num_chan = val; in read_dmac_config()
1832 pl330->pcfg.num_peri = val; in read_dmac_config()
1833 pl330->pcfg.peri_ns = readl(regs + CR4); in read_dmac_config()
1835 pl330->pcfg.num_peri = 0; in read_dmac_config()
1840 pl330->pcfg.mode |= DMAC_MODE_NS; in read_dmac_config()
1842 pl330->pcfg.mode &= ~DMAC_MODE_NS; in read_dmac_config()
1847 pl330->pcfg.num_events = val; in read_dmac_config()
1849 pl330->pcfg.irq_ns = readl(regs + CR3); in read_dmac_config()
1854 struct pl330_dmac *pl330 = thrd->dmac; in _reset_thread() local
1856 thrd->req[0].mc_cpu = pl330->mcode_cpu in _reset_thread()
1857 + (thrd->id * pl330->mcbufsz); in _reset_thread()
1858 thrd->req[0].mc_bus = pl330->mcode_bus in _reset_thread()
1859 + (thrd->id * pl330->mcbufsz); in _reset_thread()
1863 + pl330->mcbufsz / 2; in _reset_thread()
1865 + pl330->mcbufsz / 2; in _reset_thread()
1871 static int dmac_alloc_threads(struct pl330_dmac *pl330) in dmac_alloc_threads() argument
1873 int chans = pl330->pcfg.num_chan; in dmac_alloc_threads()
1878 pl330->channels = kcalloc(1 + chans, sizeof(*thrd), in dmac_alloc_threads()
1880 if (!pl330->channels) in dmac_alloc_threads()
1885 thrd = &pl330->channels[i]; in dmac_alloc_threads()
1887 thrd->dmac = pl330; in dmac_alloc_threads()
1893 thrd = &pl330->channels[chans]; in dmac_alloc_threads()
1895 thrd->dmac = pl330; in dmac_alloc_threads()
1897 pl330->manager = thrd; in dmac_alloc_threads()
1902 static int dmac_alloc_resources(struct pl330_dmac *pl330) in dmac_alloc_resources() argument
1904 int chans = pl330->pcfg.num_chan; in dmac_alloc_resources()
1911 pl330->mcode_cpu = dma_alloc_attrs(pl330->ddma.dev, in dmac_alloc_resources()
1912 chans * pl330->mcbufsz, in dmac_alloc_resources()
1913 &pl330->mcode_bus, GFP_KERNEL, in dmac_alloc_resources()
1915 if (!pl330->mcode_cpu) { in dmac_alloc_resources()
1916 dev_err(pl330->ddma.dev, "%s:%d Can't allocate memory!\n", in dmac_alloc_resources()
1921 ret = dmac_alloc_threads(pl330); in dmac_alloc_resources()
1923 dev_err(pl330->ddma.dev, "%s:%d Can't to create channels for DMAC!\n", in dmac_alloc_resources()
1925 dma_free_attrs(pl330->ddma.dev, in dmac_alloc_resources()
1926 chans * pl330->mcbufsz, in dmac_alloc_resources()
1927 pl330->mcode_cpu, pl330->mcode_bus, in dmac_alloc_resources()
1935 static int pl330_add(struct pl330_dmac *pl330) in pl330_add() argument
1940 if ((pl330->pcfg.periph_id & 0xfffff) != PERIPH_ID_VAL) { in pl330_add()
1941 dev_err(pl330->ddma.dev, "PERIPH_ID 0x%x !\n", in pl330_add()
1942 pl330->pcfg.periph_id); in pl330_add()
1947 read_dmac_config(pl330); in pl330_add()
1949 if (pl330->pcfg.num_events == 0) { in pl330_add()
1950 dev_err(pl330->ddma.dev, "%s:%d Can't work without events!\n", in pl330_add()
1955 spin_lock_init(&pl330->lock); in pl330_add()
1957 INIT_LIST_HEAD(&pl330->req_done); in pl330_add()
1960 if (!pl330->mcbufsz) in pl330_add()
1961 pl330->mcbufsz = MCODE_BUFF_PER_REQ * 2; in pl330_add()
1964 for (i = 0; i < pl330->pcfg.num_events; i++) in pl330_add()
1965 pl330->events[i] = -1; in pl330_add()
1968 ret = dmac_alloc_resources(pl330); in pl330_add()
1970 dev_err(pl330->ddma.dev, "Unable to create channels for DMAC\n"); in pl330_add()
1974 tasklet_init(&pl330->tasks, pl330_dotask, (unsigned long) pl330); in pl330_add()
1976 pl330->state = INIT; in pl330_add()
1981 static int dmac_free_threads(struct pl330_dmac *pl330) in dmac_free_threads() argument
1987 for (i = 0; i < pl330->pcfg.num_chan; i++) { in dmac_free_threads()
1988 thrd = &pl330->channels[i]; in dmac_free_threads()
1993 kfree(pl330->channels); in dmac_free_threads()
1998 static void pl330_del(struct pl330_dmac *pl330) in pl330_del() argument
2000 pl330->state = UNINIT; in pl330_del()
2002 tasklet_kill(&pl330->tasks); in pl330_del()
2005 dmac_free_threads(pl330); in pl330_del()
2007 dma_free_attrs(pl330->ddma.dev, in pl330_del()
2008 pl330->pcfg.num_chan * pl330->mcbufsz, pl330->mcode_cpu, in pl330_del()
2009 pl330->mcode_bus, DMA_ATTR_PRIVILEGED); in pl330_del()
2134 struct pl330_dmac *pl330 = ofdma->of_dma_data; in of_dma_pl330_xlate() local
2137 if (!pl330) in of_dma_pl330_xlate()
2144 if (chan_id >= pl330->num_peripherals) in of_dma_pl330_xlate()
2147 return dma_get_slave_channel(&pl330->peripherals[chan_id].chan); in of_dma_pl330_xlate()
2153 struct pl330_dmac *pl330 = pch->dmac; in pl330_alloc_chan_resources() local
2156 spin_lock_irqsave(&pl330->lock, flags); in pl330_alloc_chan_resources()
2161 pch->thread = pl330_request_channel(pl330); in pl330_alloc_chan_resources()
2163 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_alloc_chan_resources()
2169 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_alloc_chan_resources()
2275 struct pl330_dmac *pl330 = pch->dmac; in pl330_terminate_all() local
2278 pm_runtime_get_sync(pl330->ddma.dev); in pl330_terminate_all()
2281 spin_lock(&pl330->lock); in pl330_terminate_all()
2286 spin_unlock(&pl330->lock); in pl330_terminate_all()
2302 list_splice_tail_init(&pch->submitted_list, &pl330->desc_pool); in pl330_terminate_all()
2303 list_splice_tail_init(&pch->work_list, &pl330->desc_pool); in pl330_terminate_all()
2304 list_splice_tail_init(&pch->completed_list, &pl330->desc_pool); in pl330_terminate_all()
2306 pm_runtime_mark_last_busy(pl330->ddma.dev); in pl330_terminate_all()
2308 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_terminate_all()
2309 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_terminate_all()
2324 struct pl330_dmac *pl330 = pch->dmac; in pl330_pause() local
2327 pm_runtime_get_sync(pl330->ddma.dev); in pl330_pause()
2330 spin_lock(&pl330->lock); in pl330_pause()
2332 spin_unlock(&pl330->lock); in pl330_pause()
2335 pm_runtime_mark_last_busy(pl330->ddma.dev); in pl330_pause()
2336 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_pause()
2344 struct pl330_dmac *pl330 = pch->dmac; in pl330_free_chan_resources() local
2350 spin_lock_irqsave(&pl330->lock, flags); in pl330_free_chan_resources()
2358 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_free_chan_resources()
2368 struct pl330_dmac *pl330 = pch->dmac; in pl330_get_current_xferred_count() local
2372 pm_runtime_get_sync(pl330->ddma.dev); in pl330_get_current_xferred_count()
2382 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_get_current_xferred_count()
2579 struct pl330_dmac *pl330 = pch->dmac; in pl330_get_desc() local
2584 desc = pluck_desc(&pl330->desc_pool, &pl330->pool_lock); in pl330_get_desc()
2650 struct pl330_dmac *pl330 = pch->dmac; in get_burst_len() local
2653 burst_len = pl330->pcfg.data_bus_width / 8; in get_burst_len()
2654 burst_len *= pl330->pcfg.data_buf_dep / pl330->pcfg.num_chan; in get_burst_len()
2671 struct pl330_dmac *pl330 = pch->dmac; in pl330_prep_dma_cyclic() local
2699 spin_lock_irqsave(&pl330->pool_lock, flags); in pl330_prep_dma_cyclic()
2704 list_move_tail(&desc->node, &pl330->desc_pool); in pl330_prep_dma_cyclic()
2707 list_move_tail(&first->node, &pl330->desc_pool); in pl330_prep_dma_cyclic()
2709 spin_unlock_irqrestore(&pl330->pool_lock, flags); in pl330_prep_dma_cyclic()
2760 struct pl330_dmac *pl330; in pl330_prep_dma_memcpy() local
2766 pl330 = pch->dmac; in pl330_prep_dma_memcpy()
2777 burst = pl330->pcfg.data_bus_width / 8; in pl330_prep_dma_memcpy()
2795 if (desc->rqcfg.brst_size * 8 < pl330->pcfg.data_bus_width) in pl330_prep_dma_memcpy()
2806 static void __pl330_giveback_desc(struct pl330_dmac *pl330, in __pl330_giveback_desc() argument
2815 spin_lock_irqsave(&pl330->pool_lock, flags); in __pl330_giveback_desc()
2820 list_move_tail(&desc->node, &pl330->desc_pool); in __pl330_giveback_desc()
2823 list_move_tail(&first->node, &pl330->desc_pool); in __pl330_giveback_desc()
2825 spin_unlock_irqrestore(&pl330->pool_lock, flags); in __pl330_giveback_desc()
2852 struct pl330_dmac *pl330 = pch->dmac; in pl330_prep_slave_sg() local
2857 __pl330_giveback_desc(pl330, first); in pl330_prep_slave_sg()
2908 struct pl330_dmac *pl330 = s->private; in pl330_debugfs_show() local
2911 chans = pl330->pcfg.num_chan; in pl330_debugfs_show()
2912 pchs = pl330->num_peripherals; in pl330_debugfs_show()
2918 struct pl330_thread *thrd = &pl330->channels[ch]; in pl330_debugfs_show()
2922 struct dma_pl330_chan *pch = &pl330->peripherals[pr]; in pl330_debugfs_show()
2942 static inline void init_pl330_debugfs(struct pl330_dmac *pl330) in init_pl330_debugfs() argument
2944 debugfs_create_file(dev_name(pl330->ddma.dev), in init_pl330_debugfs()
2945 S_IFREG | 0444, NULL, pl330, in init_pl330_debugfs()
2949 static inline void init_pl330_debugfs(struct pl330_dmac *pl330) in init_pl330_debugfs() argument
2998 struct pl330_dmac *pl330; in pl330_probe() local
3011 pl330 = devm_kzalloc(&adev->dev, sizeof(*pl330), GFP_KERNEL); in pl330_probe()
3012 if (!pl330) in pl330_probe()
3015 pd = &pl330->ddma; in pl330_probe()
3018 pl330->mcbufsz = 0; in pl330_probe()
3023 pl330->quirks |= of_quirks[i].id; in pl330_probe()
3026 pl330->base = devm_ioremap_resource(&adev->dev, res); in pl330_probe()
3027 if (IS_ERR(pl330->base)) in pl330_probe()
3028 return PTR_ERR(pl330->base); in pl330_probe()
3030 amba_set_drvdata(adev, pl330); in pl330_probe()
3032 pl330->rstc = devm_reset_control_get_optional(&adev->dev, "dma"); in pl330_probe()
3033 if (IS_ERR(pl330->rstc)) { in pl330_probe()
3034 if (PTR_ERR(pl330->rstc) != -EPROBE_DEFER) in pl330_probe()
3036 return PTR_ERR(pl330->rstc); in pl330_probe()
3038 ret = reset_control_deassert(pl330->rstc); in pl330_probe()
3045 pl330->rstc_ocp = devm_reset_control_get_optional(&adev->dev, "dma-ocp"); in pl330_probe()
3046 if (IS_ERR(pl330->rstc_ocp)) { in pl330_probe()
3047 if (PTR_ERR(pl330->rstc_ocp) != -EPROBE_DEFER) in pl330_probe()
3049 return PTR_ERR(pl330->rstc_ocp); in pl330_probe()
3051 ret = reset_control_deassert(pl330->rstc_ocp); in pl330_probe()
3063 dev_name(&adev->dev), pl330); in pl330_probe()
3071 pcfg = &pl330->pcfg; in pl330_probe()
3074 ret = pl330_add(pl330); in pl330_probe()
3078 INIT_LIST_HEAD(&pl330->desc_pool); in pl330_probe()
3079 spin_lock_init(&pl330->pool_lock); in pl330_probe()
3082 if (!add_desc(&pl330->desc_pool, &pl330->pool_lock, in pl330_probe()
3091 pl330->num_peripherals = num_chan; in pl330_probe()
3093 pl330->peripherals = kcalloc(num_chan, sizeof(*pch), GFP_KERNEL); in pl330_probe()
3094 if (!pl330->peripherals) { in pl330_probe()
3100 pch = &pl330->peripherals[i]; in pl330_probe()
3109 pch->dmac = pl330; in pl330_probe()
3137 pd->max_burst = ((pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP) ? in pl330_probe()
3148 of_dma_pl330_xlate, pl330); in pl330_probe()
3155 adev->dev.dma_parms = &pl330->dma_parms; in pl330_probe()
3166 init_pl330_debugfs(pl330); in pl330_probe()
3183 list_for_each_entry_safe(pch, _p, &pl330->ddma.channels, in pl330_probe()
3196 pl330_del(pl330); in pl330_probe()
3198 if (pl330->rstc_ocp) in pl330_probe()
3199 reset_control_assert(pl330->rstc_ocp); in pl330_probe()
3201 if (pl330->rstc) in pl330_probe()
3202 reset_control_assert(pl330->rstc); in pl330_probe()
3208 struct pl330_dmac *pl330 = amba_get_drvdata(adev); in pl330_remove() local
3212 pm_runtime_get_noresume(pl330->ddma.dev); in pl330_remove()
3220 devm_free_irq(&adev->dev, irq, pl330); in pl330_remove()
3223 dma_async_device_unregister(&pl330->ddma); in pl330_remove()
3226 list_for_each_entry_safe(pch, _p, &pl330->ddma.channels, in pl330_remove()
3239 pl330_del(pl330); in pl330_remove()
3241 if (pl330->rstc_ocp) in pl330_remove()
3242 reset_control_assert(pl330->rstc_ocp); in pl330_remove()
3244 if (pl330->rstc) in pl330_remove()
3245 reset_control_assert(pl330->rstc); in pl330_remove()