Lines Matching refs:pl330
1179 static inline int _ldst_peripheral(struct pl330_dmac *pl330, in _ldst_peripheral() argument
1190 if (!(pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP)) in _ldst_peripheral()
1203 static int _bursts(struct pl330_dmac *pl330, unsigned dry_run, u8 buf[], in _bursts() argument
1209 if (pl330->quirks & PL330_QUIRK_PERIPH_BURST) in _bursts()
1215 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
1265 off += _ldst_peripheral(pl330, dry_run, &buf[off], pxs, 1, in _dregs()
1284 static inline int _loop(struct pl330_dmac *pl330, unsigned dry_run, u8 buf[], in _loop() argument
1292 return _bursts(pl330, dry_run, buf, pxs, 1); in _loop()
1310 szbrst = _bursts(pl330, 1, buf, pxs, 1); in _loop()
1342 off += _bursts(pl330, dry_run, &buf[off], pxs, cyc); in _loop()
1365 static inline int _setup_loops(struct pl330_dmac *pl330, in _setup_loops() argument
1378 off += _loop(pl330, dry_run, &buf[off], &c, pxs); in _setup_loops()
1381 off += _dregs(pl330, dry_run, &buf[off], pxs, num_dregs); in _setup_loops()
1386 static inline int _setup_xfer(struct pl330_dmac *pl330, in _setup_xfer() argument
1399 off += _setup_loops(pl330, dry_run, &buf[off], pxs); in _setup_xfer()
1408 static int _setup_req(struct pl330_dmac *pl330, unsigned dry_run, in _setup_req() argument
1421 off += _setup_xfer(pl330, dry_run, &buf[off], pxs); in _setup_req()
1471 struct pl330_dmac *pl330 = thrd->dmac; in pl330_submit_req() local
1492 if (pl330->state == DYING in pl330_submit_req()
1493 || pl330->dmac_tbd.reset_chan & (1 << thrd->id)) { in pl330_submit_req()
1501 desc->peri >= pl330->pcfg.num_peri) { in pl330_submit_req()
1508 spin_lock_irqsave(&pl330->lock, flags); in pl330_submit_req()
1529 ret = _setup_req(pl330, 1, thrd, idx, &xs); in pl330_submit_req()
1531 if (ret > pl330->mcbufsz / 2) { in pl330_submit_req()
1532 dev_info(pl330->ddma.dev, "%s:%d Try increasing mcbufsz (%i/%i)\n", in pl330_submit_req()
1533 __func__, __LINE__, ret, pl330->mcbufsz / 2); in pl330_submit_req()
1541 _setup_req(pl330, 0, thrd, idx, &xs); in pl330_submit_req()
1546 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_submit_req()
1576 struct pl330_dmac *pl330 = from_tasklet(pl330, t, tasks); in pl330_dotask() local
1580 spin_lock_irqsave(&pl330->lock, flags); in pl330_dotask()
1583 if (pl330->dmac_tbd.reset_dmac) { in pl330_dotask()
1584 pl330->state = DYING; in pl330_dotask()
1586 pl330->dmac_tbd.reset_mngr = true; in pl330_dotask()
1588 pl330->dmac_tbd.reset_dmac = false; in pl330_dotask()
1591 if (pl330->dmac_tbd.reset_mngr) { in pl330_dotask()
1592 _stop(pl330->manager); in pl330_dotask()
1594 pl330->dmac_tbd.reset_chan = (1 << pl330->pcfg.num_chan) - 1; in pl330_dotask()
1596 pl330->dmac_tbd.reset_mngr = false; in pl330_dotask()
1599 for (i = 0; i < pl330->pcfg.num_chan; i++) { in pl330_dotask()
1601 if (pl330->dmac_tbd.reset_chan & (1 << i)) { in pl330_dotask()
1602 struct pl330_thread *thrd = &pl330->channels[i]; in pl330_dotask()
1603 void __iomem *regs = pl330->base; in pl330_dotask()
1613 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_dotask()
1616 spin_lock_irqsave(&pl330->lock, flags); in pl330_dotask()
1623 pl330->dmac_tbd.reset_chan &= ~(1 << i); in pl330_dotask()
1627 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_dotask()
1633 static int pl330_update(struct pl330_dmac *pl330) in pl330_update() argument
1641 regs = pl330->base; in pl330_update()
1643 spin_lock_irqsave(&pl330->lock, flags); in pl330_update()
1647 pl330->dmac_tbd.reset_mngr = true; in pl330_update()
1649 pl330->dmac_tbd.reset_mngr = false; in pl330_update()
1651 val = readl(regs + FSC) & ((1 << pl330->pcfg.num_chan) - 1); in pl330_update()
1652 pl330->dmac_tbd.reset_chan |= val; in pl330_update()
1655 while (i < pl330->pcfg.num_chan) { in pl330_update()
1657 dev_info(pl330->ddma.dev, in pl330_update()
1661 _stop(&pl330->channels[i]); in pl330_update()
1669 if (pl330->pcfg.num_events < 32 in pl330_update()
1670 && val & ~((1 << pl330->pcfg.num_events) - 1)) { in pl330_update()
1671 pl330->dmac_tbd.reset_dmac = true; in pl330_update()
1672 dev_err(pl330->ddma.dev, "%s:%d Unexpected!\n", __func__, in pl330_update()
1678 for (ev = 0; ev < pl330->pcfg.num_events; ev++) { in pl330_update()
1690 id = pl330->events[ev]; in pl330_update()
1692 thrd = &pl330->channels[id]; in pl330_update()
1708 list_add_tail(&descdone->rqd, &pl330->req_done); in pl330_update()
1713 while (!list_empty(&pl330->req_done)) { in pl330_update()
1714 descdone = list_first_entry(&pl330->req_done, in pl330_update()
1717 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_update()
1719 spin_lock_irqsave(&pl330->lock, flags); in pl330_update()
1723 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_update()
1725 if (pl330->dmac_tbd.reset_dmac in pl330_update()
1726 || pl330->dmac_tbd.reset_mngr in pl330_update()
1727 || pl330->dmac_tbd.reset_chan) { in pl330_update()
1729 tasklet_schedule(&pl330->tasks); in pl330_update()
1738 struct pl330_dmac *pl330 = thrd->dmac; in _alloc_event() local
1741 for (ev = 0; ev < pl330->pcfg.num_events; ev++) in _alloc_event()
1742 if (pl330->events[ev] == -1) { in _alloc_event()
1743 pl330->events[ev] = thrd->id; in _alloc_event()
1750 static bool _chan_ns(const struct pl330_dmac *pl330, int i) in _chan_ns() argument
1752 return pl330->pcfg.irq_ns & (1 << i); in _chan_ns()
1758 static struct pl330_thread *pl330_request_channel(struct pl330_dmac *pl330) in pl330_request_channel() argument
1763 if (pl330->state == DYING) in pl330_request_channel()
1766 chans = pl330->pcfg.num_chan; in pl330_request_channel()
1769 thrd = &pl330->channels[i]; in pl330_request_channel()
1771 _chan_ns(pl330, i))) { in pl330_request_channel()
1791 struct pl330_dmac *pl330 = thrd->dmac; in _free_event() local
1794 if (ev >= 0 && ev < pl330->pcfg.num_events in _free_event()
1795 && pl330->events[ev] == thrd->id) in _free_event()
1796 pl330->events[ev] = -1; in _free_event()
1816 static void read_dmac_config(struct pl330_dmac *pl330) in read_dmac_config() argument
1818 void __iomem *regs = pl330->base; in read_dmac_config()
1823 pl330->pcfg.data_bus_width = 8 * (1 << val); in read_dmac_config()
1827 pl330->pcfg.data_buf_dep = val + 1; in read_dmac_config()
1832 pl330->pcfg.num_chan = val; in read_dmac_config()
1838 pl330->pcfg.num_peri = val; in read_dmac_config()
1839 pl330->pcfg.peri_ns = readl(regs + CR4); in read_dmac_config()
1841 pl330->pcfg.num_peri = 0; in read_dmac_config()
1846 pl330->pcfg.mode |= DMAC_MODE_NS; in read_dmac_config()
1848 pl330->pcfg.mode &= ~DMAC_MODE_NS; in read_dmac_config()
1853 pl330->pcfg.num_events = val; in read_dmac_config()
1855 pl330->pcfg.irq_ns = readl(regs + CR3); in read_dmac_config()
1860 struct pl330_dmac *pl330 = thrd->dmac; in _reset_thread() local
1862 thrd->req[0].mc_cpu = pl330->mcode_cpu in _reset_thread()
1863 + (thrd->id * pl330->mcbufsz); in _reset_thread()
1864 thrd->req[0].mc_bus = pl330->mcode_bus in _reset_thread()
1865 + (thrd->id * pl330->mcbufsz); in _reset_thread()
1869 + pl330->mcbufsz / 2; in _reset_thread()
1871 + pl330->mcbufsz / 2; in _reset_thread()
1877 static int dmac_alloc_threads(struct pl330_dmac *pl330) in dmac_alloc_threads() argument
1879 int chans = pl330->pcfg.num_chan; in dmac_alloc_threads()
1884 pl330->channels = kcalloc(1 + chans, sizeof(*thrd), in dmac_alloc_threads()
1886 if (!pl330->channels) in dmac_alloc_threads()
1891 thrd = &pl330->channels[i]; in dmac_alloc_threads()
1893 thrd->dmac = pl330; in dmac_alloc_threads()
1899 thrd = &pl330->channels[chans]; in dmac_alloc_threads()
1901 thrd->dmac = pl330; in dmac_alloc_threads()
1903 pl330->manager = thrd; in dmac_alloc_threads()
1908 static int dmac_alloc_resources(struct pl330_dmac *pl330) in dmac_alloc_resources() argument
1910 int chans = pl330->pcfg.num_chan; in dmac_alloc_resources()
1917 pl330->mcode_cpu = dma_alloc_attrs(pl330->ddma.dev, in dmac_alloc_resources()
1918 chans * pl330->mcbufsz, in dmac_alloc_resources()
1919 &pl330->mcode_bus, GFP_KERNEL, in dmac_alloc_resources()
1921 if (!pl330->mcode_cpu) { in dmac_alloc_resources()
1922 dev_err(pl330->ddma.dev, "%s:%d Can't allocate memory!\n", in dmac_alloc_resources()
1927 ret = dmac_alloc_threads(pl330); in dmac_alloc_resources()
1929 dev_err(pl330->ddma.dev, "%s:%d Can't to create channels for DMAC!\n", in dmac_alloc_resources()
1931 dma_free_attrs(pl330->ddma.dev, in dmac_alloc_resources()
1932 chans * pl330->mcbufsz, in dmac_alloc_resources()
1933 pl330->mcode_cpu, pl330->mcode_bus, in dmac_alloc_resources()
1941 static int pl330_add(struct pl330_dmac *pl330) in pl330_add() argument
1946 if ((pl330->pcfg.periph_id & 0xfffff) != PERIPH_ID_VAL) { in pl330_add()
1947 dev_err(pl330->ddma.dev, "PERIPH_ID 0x%x !\n", in pl330_add()
1948 pl330->pcfg.periph_id); in pl330_add()
1953 read_dmac_config(pl330); in pl330_add()
1955 if (pl330->pcfg.num_events == 0) { in pl330_add()
1956 dev_err(pl330->ddma.dev, "%s:%d Can't work without events!\n", in pl330_add()
1961 spin_lock_init(&pl330->lock); in pl330_add()
1963 INIT_LIST_HEAD(&pl330->req_done); in pl330_add()
1966 if (!pl330->mcbufsz) in pl330_add()
1967 pl330->mcbufsz = MCODE_BUFF_PER_REQ * 2; in pl330_add()
1970 for (i = 0; i < pl330->pcfg.num_events; i++) in pl330_add()
1971 pl330->events[i] = -1; in pl330_add()
1974 ret = dmac_alloc_resources(pl330); in pl330_add()
1976 dev_err(pl330->ddma.dev, "Unable to create channels for DMAC\n"); in pl330_add()
1980 tasklet_setup(&pl330->tasks, pl330_dotask); in pl330_add()
1982 pl330->state = INIT; in pl330_add()
1987 static int dmac_free_threads(struct pl330_dmac *pl330) in dmac_free_threads() argument
1993 for (i = 0; i < pl330->pcfg.num_chan; i++) { in dmac_free_threads()
1994 thrd = &pl330->channels[i]; in dmac_free_threads()
1999 kfree(pl330->channels); in dmac_free_threads()
2004 static void pl330_del(struct pl330_dmac *pl330) in pl330_del() argument
2006 pl330->state = UNINIT; in pl330_del()
2008 tasklet_kill(&pl330->tasks); in pl330_del()
2011 dmac_free_threads(pl330); in pl330_del()
2013 dma_free_attrs(pl330->ddma.dev, in pl330_del()
2014 pl330->pcfg.num_chan * pl330->mcbufsz, pl330->mcode_cpu, in pl330_del()
2015 pl330->mcode_bus, DMA_ATTR_PRIVILEGED); in pl330_del()
2140 struct pl330_dmac *pl330 = ofdma->of_dma_data; in of_dma_pl330_xlate() local
2143 if (!pl330) in of_dma_pl330_xlate()
2150 if (chan_id >= pl330->num_peripherals) in of_dma_pl330_xlate()
2153 return dma_get_slave_channel(&pl330->peripherals[chan_id].chan); in of_dma_pl330_xlate()
2159 struct pl330_dmac *pl330 = pch->dmac; in pl330_alloc_chan_resources() local
2162 spin_lock_irqsave(&pl330->lock, flags); in pl330_alloc_chan_resources()
2167 pch->thread = pl330_request_channel(pl330); in pl330_alloc_chan_resources()
2169 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_alloc_chan_resources()
2175 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_alloc_chan_resources()
2279 struct pl330_dmac *pl330 = pch->dmac; in pl330_terminate_all() local
2282 pm_runtime_get_sync(pl330->ddma.dev); in pl330_terminate_all()
2285 spin_lock(&pl330->lock); in pl330_terminate_all()
2290 spin_unlock(&pl330->lock); in pl330_terminate_all()
2306 list_splice_tail_init(&pch->submitted_list, &pl330->desc_pool); in pl330_terminate_all()
2307 list_splice_tail_init(&pch->work_list, &pl330->desc_pool); in pl330_terminate_all()
2308 list_splice_tail_init(&pch->completed_list, &pl330->desc_pool); in pl330_terminate_all()
2310 pm_runtime_mark_last_busy(pl330->ddma.dev); in pl330_terminate_all()
2312 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_terminate_all()
2313 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_terminate_all()
2328 struct pl330_dmac *pl330 = pch->dmac; in pl330_pause() local
2331 pm_runtime_get_sync(pl330->ddma.dev); in pl330_pause()
2334 spin_lock(&pl330->lock); in pl330_pause()
2336 spin_unlock(&pl330->lock); in pl330_pause()
2339 pm_runtime_mark_last_busy(pl330->ddma.dev); in pl330_pause()
2340 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_pause()
2348 struct pl330_dmac *pl330 = pch->dmac; in pl330_free_chan_resources() local
2354 spin_lock_irqsave(&pl330->lock, flags); in pl330_free_chan_resources()
2362 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_free_chan_resources()
2372 struct pl330_dmac *pl330 = pch->dmac; in pl330_get_current_xferred_count() local
2376 pm_runtime_get_sync(pl330->ddma.dev); in pl330_get_current_xferred_count()
2386 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_get_current_xferred_count()
2583 struct pl330_dmac *pl330 = pch->dmac; in pl330_get_desc() local
2588 desc = pluck_desc(&pl330->desc_pool, &pl330->pool_lock); in pl330_get_desc()
2654 struct pl330_dmac *pl330 = pch->dmac; in get_burst_len() local
2657 burst_len = pl330->pcfg.data_bus_width / 8; in get_burst_len()
2658 burst_len *= pl330->pcfg.data_buf_dep / pl330->pcfg.num_chan; in get_burst_len()
2675 struct pl330_dmac *pl330 = pch->dmac; in pl330_prep_dma_cyclic() local
2705 spin_lock_irqsave(&pl330->pool_lock, iflags); in pl330_prep_dma_cyclic()
2710 list_move_tail(&desc->node, &pl330->desc_pool); in pl330_prep_dma_cyclic()
2713 list_move_tail(&first->node, &pl330->desc_pool); in pl330_prep_dma_cyclic()
2715 spin_unlock_irqrestore(&pl330->pool_lock, iflags); in pl330_prep_dma_cyclic()
2765 struct pl330_dmac *pl330; in pl330_prep_dma_memcpy() local
2771 pl330 = pch->dmac; in pl330_prep_dma_memcpy()
2782 burst = pl330->pcfg.data_bus_width / 8; in pl330_prep_dma_memcpy()
2801 if (burst * 8 < pl330->pcfg.data_bus_width) in pl330_prep_dma_memcpy()
2809 static void __pl330_giveback_desc(struct pl330_dmac *pl330, in __pl330_giveback_desc() argument
2818 spin_lock_irqsave(&pl330->pool_lock, flags); in __pl330_giveback_desc()
2823 list_move_tail(&desc->node, &pl330->desc_pool); in __pl330_giveback_desc()
2826 list_move_tail(&first->node, &pl330->desc_pool); in __pl330_giveback_desc()
2828 spin_unlock_irqrestore(&pl330->pool_lock, flags); in __pl330_giveback_desc()
2855 struct pl330_dmac *pl330 = pch->dmac; in pl330_prep_slave_sg() local
2860 __pl330_giveback_desc(pl330, first); in pl330_prep_slave_sg()
2910 struct pl330_dmac *pl330 = s->private; in pl330_debugfs_show() local
2913 chans = pl330->pcfg.num_chan; in pl330_debugfs_show()
2914 pchs = pl330->num_peripherals; in pl330_debugfs_show()
2920 struct pl330_thread *thrd = &pl330->channels[ch]; in pl330_debugfs_show()
2924 struct dma_pl330_chan *pch = &pl330->peripherals[pr]; in pl330_debugfs_show()
2944 static inline void init_pl330_debugfs(struct pl330_dmac *pl330) in init_pl330_debugfs() argument
2946 debugfs_create_file(dev_name(pl330->ddma.dev), in init_pl330_debugfs()
2947 S_IFREG | 0444, NULL, pl330, in init_pl330_debugfs()
2951 static inline void init_pl330_debugfs(struct pl330_dmac *pl330) in init_pl330_debugfs() argument
2994 struct pl330_dmac *pl330; in pl330_probe() local
3007 pl330 = devm_kzalloc(&adev->dev, sizeof(*pl330), GFP_KERNEL); in pl330_probe()
3008 if (!pl330) in pl330_probe()
3011 pd = &pl330->ddma; in pl330_probe()
3014 pl330->mcbufsz = 0; in pl330_probe()
3019 pl330->quirks |= of_quirks[i].id; in pl330_probe()
3022 pl330->base = devm_ioremap_resource(&adev->dev, res); in pl330_probe()
3023 if (IS_ERR(pl330->base)) in pl330_probe()
3024 return PTR_ERR(pl330->base); in pl330_probe()
3026 amba_set_drvdata(adev, pl330); in pl330_probe()
3028 pl330->rstc = devm_reset_control_get_optional(&adev->dev, "dma"); in pl330_probe()
3029 if (IS_ERR(pl330->rstc)) { in pl330_probe()
3030 return dev_err_probe(&adev->dev, PTR_ERR(pl330->rstc), "Failed to get reset!\n"); in pl330_probe()
3032 ret = reset_control_deassert(pl330->rstc); in pl330_probe()
3039 pl330->rstc_ocp = devm_reset_control_get_optional(&adev->dev, "dma-ocp"); in pl330_probe()
3040 if (IS_ERR(pl330->rstc_ocp)) { in pl330_probe()
3041 return dev_err_probe(&adev->dev, PTR_ERR(pl330->rstc_ocp), in pl330_probe()
3044 ret = reset_control_deassert(pl330->rstc_ocp); in pl330_probe()
3056 dev_name(&adev->dev), pl330); in pl330_probe()
3064 pcfg = &pl330->pcfg; in pl330_probe()
3067 ret = pl330_add(pl330); in pl330_probe()
3071 INIT_LIST_HEAD(&pl330->desc_pool); in pl330_probe()
3072 spin_lock_init(&pl330->pool_lock); in pl330_probe()
3075 if (!add_desc(&pl330->desc_pool, &pl330->pool_lock, in pl330_probe()
3084 pl330->num_peripherals = num_chan; in pl330_probe()
3086 pl330->peripherals = kcalloc(num_chan, sizeof(*pch), GFP_KERNEL); in pl330_probe()
3087 if (!pl330->peripherals) { in pl330_probe()
3093 pch = &pl330->peripherals[i]; in pl330_probe()
3102 pch->dmac = pl330; in pl330_probe()
3140 of_dma_pl330_xlate, pl330); in pl330_probe()
3156 init_pl330_debugfs(pl330); in pl330_probe()
3173 list_for_each_entry_safe(pch, _p, &pl330->ddma.channels, in pl330_probe()
3186 pl330_del(pl330); in pl330_probe()
3188 if (pl330->rstc_ocp) in pl330_probe()
3189 reset_control_assert(pl330->rstc_ocp); in pl330_probe()
3191 if (pl330->rstc) in pl330_probe()
3192 reset_control_assert(pl330->rstc); in pl330_probe()
3198 struct pl330_dmac *pl330 = amba_get_drvdata(adev); in pl330_remove() local
3202 pm_runtime_get_noresume(pl330->ddma.dev); in pl330_remove()
3210 devm_free_irq(&adev->dev, irq, pl330); in pl330_remove()
3213 dma_async_device_unregister(&pl330->ddma); in pl330_remove()
3216 list_for_each_entry_safe(pch, _p, &pl330->ddma.channels, in pl330_remove()
3229 pl330_del(pl330); in pl330_remove()
3231 if (pl330->rstc_ocp) in pl330_remove()
3232 reset_control_assert(pl330->rstc_ocp); in pl330_remove()
3234 if (pl330->rstc) in pl330_remove()
3235 reset_control_assert(pl330->rstc); in pl330_remove()