Lines Matching refs:pl330
1169 static inline int _ldst_peripheral(struct pl330_dmac *pl330, in _ldst_peripheral() argument
1176 if (pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP) in _ldst_peripheral()
1183 if (!(pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP)) in _ldst_peripheral()
1196 static int _bursts(struct pl330_dmac *pl330, unsigned dry_run, u8 buf[], in _bursts() argument
1206 off += _ldst_peripheral(pl330, dry_run, &buf[off], pxs, cyc, in _bursts()
1227 static int _dregs(struct pl330_dmac *pl330, unsigned int dry_run, u8 buf[], in _dregs() argument
1240 off += _ldst_peripheral(pl330, dry_run, &buf[off], pxs, in _dregs()
1266 static inline int _loop(struct pl330_dmac *pl330, unsigned dry_run, u8 buf[], in _loop() argument
1274 return _bursts(pl330, dry_run, buf, pxs, 1); in _loop()
1292 szbrst = _bursts(pl330, 1, buf, pxs, 1); in _loop()
1324 off += _bursts(pl330, dry_run, &buf[off], pxs, cyc); in _loop()
1347 static inline int _setup_loops(struct pl330_dmac *pl330, in _setup_loops() argument
1360 off += _loop(pl330, dry_run, &buf[off], &c, pxs); in _setup_loops()
1363 off += _dregs(pl330, dry_run, &buf[off], pxs, num_dregs); in _setup_loops()
1368 static inline int _setup_xfer(struct pl330_dmac *pl330, in _setup_xfer() argument
1381 off += _setup_loops(pl330, dry_run, &buf[off], pxs); in _setup_xfer()
1390 static int _setup_req(struct pl330_dmac *pl330, unsigned dry_run, in _setup_req() argument
1403 off += _setup_xfer(pl330, dry_run, &buf[off], pxs); in _setup_req()
1453 struct pl330_dmac *pl330 = thrd->dmac; in pl330_submit_req() local
1474 if (pl330->state == DYING in pl330_submit_req()
1475 || pl330->dmac_tbd.reset_chan & (1 << thrd->id)) { in pl330_submit_req()
1483 desc->peri >= pl330->pcfg.num_peri) { in pl330_submit_req()
1490 spin_lock_irqsave(&pl330->lock, flags); in pl330_submit_req()
1511 ret = _setup_req(pl330, 1, thrd, idx, &xs); in pl330_submit_req()
1515 if (ret > pl330->mcbufsz / 2) { in pl330_submit_req()
1516 dev_info(pl330->ddma.dev, "%s:%d Try increasing mcbufsz (%i/%i)\n", in pl330_submit_req()
1517 __func__, __LINE__, ret, pl330->mcbufsz / 2); in pl330_submit_req()
1525 _setup_req(pl330, 0, thrd, idx, &xs); in pl330_submit_req()
1530 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_submit_req()
1560 struct pl330_dmac *pl330 = (struct pl330_dmac *) data; in pl330_dotask() local
1564 spin_lock_irqsave(&pl330->lock, flags); in pl330_dotask()
1567 if (pl330->dmac_tbd.reset_dmac) { in pl330_dotask()
1568 pl330->state = DYING; in pl330_dotask()
1570 pl330->dmac_tbd.reset_mngr = true; in pl330_dotask()
1572 pl330->dmac_tbd.reset_dmac = false; in pl330_dotask()
1575 if (pl330->dmac_tbd.reset_mngr) { in pl330_dotask()
1576 _stop(pl330->manager); in pl330_dotask()
1578 pl330->dmac_tbd.reset_chan = (1 << pl330->pcfg.num_chan) - 1; in pl330_dotask()
1580 pl330->dmac_tbd.reset_mngr = false; in pl330_dotask()
1583 for (i = 0; i < pl330->pcfg.num_chan; i++) { in pl330_dotask()
1585 if (pl330->dmac_tbd.reset_chan & (1 << i)) { in pl330_dotask()
1586 struct pl330_thread *thrd = &pl330->channels[i]; in pl330_dotask()
1587 void __iomem *regs = pl330->base; in pl330_dotask()
1597 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_dotask()
1600 spin_lock_irqsave(&pl330->lock, flags); in pl330_dotask()
1607 pl330->dmac_tbd.reset_chan &= ~(1 << i); in pl330_dotask()
1611 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_dotask()
1617 static int pl330_update(struct pl330_dmac *pl330) in pl330_update() argument
1625 regs = pl330->base; in pl330_update()
1627 spin_lock_irqsave(&pl330->lock, flags); in pl330_update()
1631 pl330->dmac_tbd.reset_mngr = true; in pl330_update()
1633 pl330->dmac_tbd.reset_mngr = false; in pl330_update()
1635 val = readl(regs + FSC) & ((1 << pl330->pcfg.num_chan) - 1); in pl330_update()
1636 pl330->dmac_tbd.reset_chan |= val; in pl330_update()
1639 while (i < pl330->pcfg.num_chan) { in pl330_update()
1641 dev_info(pl330->ddma.dev, in pl330_update()
1645 _stop(&pl330->channels[i]); in pl330_update()
1653 if (pl330->pcfg.num_events < 32 in pl330_update()
1654 && val & ~((1 << pl330->pcfg.num_events) - 1)) { in pl330_update()
1655 pl330->dmac_tbd.reset_dmac = true; in pl330_update()
1656 dev_err(pl330->ddma.dev, "%s:%d Unexpected!\n", __func__, in pl330_update()
1662 for (ev = 0; ev < pl330->pcfg.num_events; ev++) { in pl330_update()
1674 id = pl330->events[ev]; in pl330_update()
1676 thrd = &pl330->channels[id]; in pl330_update()
1692 list_add_tail(&descdone->rqd, &pl330->req_done); in pl330_update()
1697 while (!list_empty(&pl330->req_done)) { in pl330_update()
1698 descdone = list_first_entry(&pl330->req_done, in pl330_update()
1701 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_update()
1703 spin_lock_irqsave(&pl330->lock, flags); in pl330_update()
1707 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_update()
1709 if (pl330->dmac_tbd.reset_dmac in pl330_update()
1710 || pl330->dmac_tbd.reset_mngr in pl330_update()
1711 || pl330->dmac_tbd.reset_chan) { in pl330_update()
1713 tasklet_schedule(&pl330->tasks); in pl330_update()
1722 struct pl330_dmac *pl330 = thrd->dmac; in _alloc_event() local
1725 for (ev = 0; ev < pl330->pcfg.num_events; ev++) in _alloc_event()
1726 if (pl330->events[ev] == -1) { in _alloc_event()
1727 pl330->events[ev] = thrd->id; in _alloc_event()
1734 static bool _chan_ns(const struct pl330_dmac *pl330, int i) in _chan_ns() argument
1736 return pl330->pcfg.irq_ns & (1 << i); in _chan_ns()
1742 static struct pl330_thread *pl330_request_channel(struct pl330_dmac *pl330) in pl330_request_channel() argument
1747 if (pl330->state == DYING) in pl330_request_channel()
1750 chans = pl330->pcfg.num_chan; in pl330_request_channel()
1753 thrd = &pl330->channels[i]; in pl330_request_channel()
1755 _chan_ns(pl330, i))) { in pl330_request_channel()
1775 struct pl330_dmac *pl330 = thrd->dmac; in _free_event() local
1778 if (ev >= 0 && ev < pl330->pcfg.num_events in _free_event()
1779 && pl330->events[ev] == thrd->id) in _free_event()
1780 pl330->events[ev] = -1; in _free_event()
1800 static void read_dmac_config(struct pl330_dmac *pl330) in read_dmac_config() argument
1802 void __iomem *regs = pl330->base; in read_dmac_config()
1807 pl330->pcfg.data_bus_width = 8 * (1 << val); in read_dmac_config()
1811 pl330->pcfg.data_buf_dep = val + 1; in read_dmac_config()
1816 pl330->pcfg.num_chan = val; in read_dmac_config()
1822 pl330->pcfg.num_peri = val; in read_dmac_config()
1823 pl330->pcfg.peri_ns = readl(regs + CR4); in read_dmac_config()
1825 pl330->pcfg.num_peri = 0; in read_dmac_config()
1830 pl330->pcfg.mode |= DMAC_MODE_NS; in read_dmac_config()
1832 pl330->pcfg.mode &= ~DMAC_MODE_NS; in read_dmac_config()
1837 pl330->pcfg.num_events = val; in read_dmac_config()
1839 pl330->pcfg.irq_ns = readl(regs + CR3); in read_dmac_config()
1844 struct pl330_dmac *pl330 = thrd->dmac; in _reset_thread() local
1846 thrd->req[0].mc_cpu = pl330->mcode_cpu in _reset_thread()
1847 + (thrd->id * pl330->mcbufsz); in _reset_thread()
1848 thrd->req[0].mc_bus = pl330->mcode_bus in _reset_thread()
1849 + (thrd->id * pl330->mcbufsz); in _reset_thread()
1853 + pl330->mcbufsz / 2; in _reset_thread()
1855 + pl330->mcbufsz / 2; in _reset_thread()
1861 static int dmac_alloc_threads(struct pl330_dmac *pl330) in dmac_alloc_threads() argument
1863 int chans = pl330->pcfg.num_chan; in dmac_alloc_threads()
1868 pl330->channels = kcalloc(1 + chans, sizeof(*thrd), in dmac_alloc_threads()
1870 if (!pl330->channels) in dmac_alloc_threads()
1875 thrd = &pl330->channels[i]; in dmac_alloc_threads()
1877 thrd->dmac = pl330; in dmac_alloc_threads()
1883 thrd = &pl330->channels[chans]; in dmac_alloc_threads()
1885 thrd->dmac = pl330; in dmac_alloc_threads()
1887 pl330->manager = thrd; in dmac_alloc_threads()
1892 static int dmac_alloc_resources(struct pl330_dmac *pl330) in dmac_alloc_resources() argument
1894 int chans = pl330->pcfg.num_chan; in dmac_alloc_resources()
1901 pl330->mcode_cpu = dma_alloc_attrs(pl330->ddma.dev, in dmac_alloc_resources()
1902 chans * pl330->mcbufsz, in dmac_alloc_resources()
1903 &pl330->mcode_bus, GFP_KERNEL, in dmac_alloc_resources()
1905 if (!pl330->mcode_cpu) { in dmac_alloc_resources()
1906 dev_err(pl330->ddma.dev, "%s:%d Can't allocate memory!\n", in dmac_alloc_resources()
1911 ret = dmac_alloc_threads(pl330); in dmac_alloc_resources()
1913 dev_err(pl330->ddma.dev, "%s:%d Can't to create channels for DMAC!\n", in dmac_alloc_resources()
1915 dma_free_coherent(pl330->ddma.dev, in dmac_alloc_resources()
1916 chans * pl330->mcbufsz, in dmac_alloc_resources()
1917 pl330->mcode_cpu, pl330->mcode_bus); in dmac_alloc_resources()
1924 static int pl330_add(struct pl330_dmac *pl330) in pl330_add() argument
1929 if ((pl330->pcfg.periph_id & 0xfffff) != PERIPH_ID_VAL) { in pl330_add()
1930 dev_err(pl330->ddma.dev, "PERIPH_ID 0x%x !\n", in pl330_add()
1931 pl330->pcfg.periph_id); in pl330_add()
1936 read_dmac_config(pl330); in pl330_add()
1938 if (pl330->pcfg.num_events == 0) { in pl330_add()
1939 dev_err(pl330->ddma.dev, "%s:%d Can't work without events!\n", in pl330_add()
1944 spin_lock_init(&pl330->lock); in pl330_add()
1946 INIT_LIST_HEAD(&pl330->req_done); in pl330_add()
1949 if (!pl330->mcbufsz) in pl330_add()
1950 pl330->mcbufsz = MCODE_BUFF_PER_REQ * 2; in pl330_add()
1953 for (i = 0; i < pl330->pcfg.num_events; i++) in pl330_add()
1954 pl330->events[i] = -1; in pl330_add()
1957 ret = dmac_alloc_resources(pl330); in pl330_add()
1959 dev_err(pl330->ddma.dev, "Unable to create channels for DMAC\n"); in pl330_add()
1963 tasklet_init(&pl330->tasks, pl330_dotask, (unsigned long) pl330); in pl330_add()
1965 pl330->state = INIT; in pl330_add()
1970 static int dmac_free_threads(struct pl330_dmac *pl330) in dmac_free_threads() argument
1976 for (i = 0; i < pl330->pcfg.num_chan; i++) { in dmac_free_threads()
1977 thrd = &pl330->channels[i]; in dmac_free_threads()
1982 kfree(pl330->channels); in dmac_free_threads()
1987 static void pl330_del(struct pl330_dmac *pl330) in pl330_del() argument
1989 pl330->state = UNINIT; in pl330_del()
1991 tasklet_kill(&pl330->tasks); in pl330_del()
1994 dmac_free_threads(pl330); in pl330_del()
1996 dma_free_coherent(pl330->ddma.dev, in pl330_del()
1997 pl330->pcfg.num_chan * pl330->mcbufsz, pl330->mcode_cpu, in pl330_del()
1998 pl330->mcode_bus); in pl330_del()
2123 struct pl330_dmac *pl330 = ofdma->of_dma_data; in of_dma_pl330_xlate() local
2126 if (!pl330) in of_dma_pl330_xlate()
2133 if (chan_id >= pl330->num_peripherals) in of_dma_pl330_xlate()
2136 return dma_get_slave_channel(&pl330->peripherals[chan_id].chan); in of_dma_pl330_xlate()
2142 struct pl330_dmac *pl330 = pch->dmac; in pl330_alloc_chan_resources() local
2145 spin_lock_irqsave(&pl330->lock, flags); in pl330_alloc_chan_resources()
2150 pch->thread = pl330_request_channel(pl330); in pl330_alloc_chan_resources()
2152 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_alloc_chan_resources()
2158 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_alloc_chan_resources()
2253 struct pl330_dmac *pl330 = pch->dmac; in pl330_terminate_all() local
2257 pm_runtime_get_sync(pl330->ddma.dev); in pl330_terminate_all()
2260 spin_lock(&pl330->lock); in pl330_terminate_all()
2265 spin_unlock(&pl330->lock); in pl330_terminate_all()
2281 list_splice_tail_init(&pch->submitted_list, &pl330->desc_pool); in pl330_terminate_all()
2282 list_splice_tail_init(&pch->work_list, &pl330->desc_pool); in pl330_terminate_all()
2283 list_splice_tail_init(&pch->completed_list, &pl330->desc_pool); in pl330_terminate_all()
2285 pm_runtime_mark_last_busy(pl330->ddma.dev); in pl330_terminate_all()
2287 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_terminate_all()
2288 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_terminate_all()
2303 struct pl330_dmac *pl330 = pch->dmac; in pl330_pause() local
2306 pm_runtime_get_sync(pl330->ddma.dev); in pl330_pause()
2309 spin_lock(&pl330->lock); in pl330_pause()
2311 spin_unlock(&pl330->lock); in pl330_pause()
2314 pm_runtime_mark_last_busy(pl330->ddma.dev); in pl330_pause()
2315 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_pause()
2323 struct pl330_dmac *pl330 = pch->dmac; in pl330_free_chan_resources() local
2329 spin_lock_irqsave(&pl330->lock, flags); in pl330_free_chan_resources()
2337 spin_unlock_irqrestore(&pl330->lock, flags); in pl330_free_chan_resources()
2347 struct pl330_dmac *pl330 = pch->dmac; in pl330_get_current_xferred_count() local
2351 pm_runtime_get_sync(pl330->ddma.dev); in pl330_get_current_xferred_count()
2361 pm_runtime_put_autosuspend(pl330->ddma.dev); in pl330_get_current_xferred_count()
2558 struct pl330_dmac *pl330 = pch->dmac; in pl330_get_desc() local
2563 desc = pluck_desc(&pl330->desc_pool, &pl330->pool_lock); in pl330_get_desc()
2629 struct pl330_dmac *pl330 = pch->dmac; in get_burst_len() local
2632 burst_len = pl330->pcfg.data_bus_width / 8; in get_burst_len()
2633 burst_len *= pl330->pcfg.data_buf_dep / pl330->pcfg.num_chan; in get_burst_len()
2650 struct pl330_dmac *pl330 = pch->dmac; in pl330_prep_dma_cyclic() local
2676 spin_lock_irqsave(&pl330->pool_lock, flags); in pl330_prep_dma_cyclic()
2681 list_move_tail(&desc->node, &pl330->desc_pool); in pl330_prep_dma_cyclic()
2684 list_move_tail(&first->node, &pl330->desc_pool); in pl330_prep_dma_cyclic()
2686 spin_unlock_irqrestore(&pl330->pool_lock, flags); in pl330_prep_dma_cyclic()
2737 struct pl330_dmac *pl330; in pl330_prep_dma_memcpy() local
2743 pl330 = pch->dmac; in pl330_prep_dma_memcpy()
2754 burst = pl330->pcfg.data_bus_width / 8; in pl330_prep_dma_memcpy()
2772 if (desc->rqcfg.brst_size * 8 < pl330->pcfg.data_bus_width) in pl330_prep_dma_memcpy()
2783 static void __pl330_giveback_desc(struct pl330_dmac *pl330, in __pl330_giveback_desc() argument
2792 spin_lock_irqsave(&pl330->pool_lock, flags); in __pl330_giveback_desc()
2797 list_move_tail(&desc->node, &pl330->desc_pool); in __pl330_giveback_desc()
2800 list_move_tail(&first->node, &pl330->desc_pool); in __pl330_giveback_desc()
2802 spin_unlock_irqrestore(&pl330->pool_lock, flags); in __pl330_giveback_desc()
2827 struct pl330_dmac *pl330 = pch->dmac; in pl330_prep_slave_sg() local
2832 __pl330_giveback_desc(pl330, first); in pl330_prep_slave_sg()
2924 struct pl330_dmac *pl330; in pl330_probe() local
2937 pl330 = devm_kzalloc(&adev->dev, sizeof(*pl330), GFP_KERNEL); in pl330_probe()
2938 if (!pl330) in pl330_probe()
2941 pd = &pl330->ddma; in pl330_probe()
2944 pl330->mcbufsz = 0; in pl330_probe()
2949 pl330->quirks |= of_quirks[i].id; in pl330_probe()
2952 pl330->base = devm_ioremap_resource(&adev->dev, res); in pl330_probe()
2953 if (IS_ERR(pl330->base)) in pl330_probe()
2954 return PTR_ERR(pl330->base); in pl330_probe()
2956 amba_set_drvdata(adev, pl330); in pl330_probe()
2963 dev_name(&adev->dev), pl330); in pl330_probe()
2971 pcfg = &pl330->pcfg; in pl330_probe()
2974 ret = pl330_add(pl330); in pl330_probe()
2978 INIT_LIST_HEAD(&pl330->desc_pool); in pl330_probe()
2979 spin_lock_init(&pl330->pool_lock); in pl330_probe()
2982 if (!add_desc(&pl330->desc_pool, &pl330->pool_lock, in pl330_probe()
2991 pl330->num_peripherals = num_chan; in pl330_probe()
2993 pl330->peripherals = kcalloc(num_chan, sizeof(*pch), GFP_KERNEL); in pl330_probe()
2994 if (!pl330->peripherals) { in pl330_probe()
3000 pch = &pl330->peripherals[i]; in pl330_probe()
3009 pch->dmac = pl330; in pl330_probe()
3037 pd->max_burst = ((pl330->quirks & PL330_QUIRK_BROKEN_NO_FLUSHP) ? in pl330_probe()
3048 of_dma_pl330_xlate, pl330); in pl330_probe()
3055 adev->dev.dma_parms = &pl330->dma_parms; in pl330_probe()
3082 list_for_each_entry_safe(pch, _p, &pl330->ddma.channels, in pl330_probe()
3095 pl330_del(pl330); in pl330_probe()
3102 struct pl330_dmac *pl330 = amba_get_drvdata(adev); in pl330_remove() local
3106 pm_runtime_get_noresume(pl330->ddma.dev); in pl330_remove()
3114 devm_free_irq(&adev->dev, irq, pl330); in pl330_remove()
3117 dma_async_device_unregister(&pl330->ddma); in pl330_remove()
3120 list_for_each_entry_safe(pch, _p, &pl330->ddma.channels, in pl330_remove()
3133 pl330_del(pl330); in pl330_remove()