drivers/dma/st_fdma.c

35 	struct st_fdma_dev *fdev = fchan->fdev;
46 		if (fdev->dreq_mask == ~0L) {
47 			dev_err(fdev->dev, "No req lines available\n");
52 			dev_err(fdev->dev, "Invalid or used req line\n");
59 	} while (test_and_set_bit(dreq_line, &fdev->dreq_mask));
61 	dev_dbg(fdev->dev, "get dreq_line:%d mask:%#lx\n",
62 		dreq_line, fdev->dreq_mask);
69 	struct st_fdma_dev *fdev = fchan->fdev;
71 	dev_dbg(fdev->dev, "put dreq_line:%#x\n", fchan->dreq_line);
72 	clear_bit(fchan->dreq_line, &fdev->dreq_mask);
93 		fchan->fdev->slim_rproc->peri + FDMA_CMD_SET_OFST);
95 	dev_dbg(fchan->fdev->dev, "start chan:%d\n", fchan->vchan.chan.chan_id);
103 	struct st_fdma_dev *fdev = fchan->fdev;
110 		dev_warn(fdev->dev, "chan:%d, error:%ld\n", ch_id, ch_err);
128 	struct st_fdma_dev *fdev = dev_id;
130 	struct st_fdma_chan *fchan = &fdev->chans[0];
133 	int_sta = fdma_read(fdev, FDMA_INT_STA_OFST);
162 	fdma_write(fdev, clr, FDMA_INT_CLR_OFST);
170 	struct st_fdma_dev *fdev = ofdma->of_dma_data;
178 	if (fdev->dma_device.dev->of_node != dma_spec->np)
181 	ret = rproc_boot(fdev->slim_rproc->rproc);
187 	chan = dma_get_any_slave_channel(&fdev->dma_device);
215 	dev_dbg(fdev->dev, "xlate req_line:%d type:%d req_ctrl:%#lx\n",
221 	rproc_shutdown(fdev->slim_rproc->rproc);
272 					    fchan->fdev->dev,
278 		dev_err(fchan->fdev->dev, "unable to allocate desc pool\n");
282 	dev_dbg(fchan->fdev->dev, "alloc ch_id:%d type:%d\n",
291 	struct rproc *rproc = fchan->fdev->slim_rproc->rproc;
294 	dev_dbg(fchan->fdev->dev, "%s: freeing chan:%d\n",
327 		dev_err(fchan->fdev->dev, "no memory for desc\n");
353 	struct st_fdma_dev *fdev = fchan->fdev;
406 	dev_dbg(fdev->dev, "chan:%d config_reqctrl:%#x req_ctrl:%#lx\n",
441 		dev_err(fchan->fdev->dev, "bad direction?\n");
465 		dev_err(fchan->fdev->dev, "bad width or direction\n");
471 		dev_err(fchan->fdev->dev, "len is not multiple of period\n");
478 		dev_err(fchan->fdev->dev, "no memory for desc\n");
527 		dev_err(fchan->fdev->dev, "no memory for desc\n");
628 	dev_dbg(fchan->fdev->dev, "pause chan:%d\n", ch_id);
632 		fdma_write(fchan->fdev, cmd, FDMA_CMD_SET_OFST);
645 	dev_dbg(fchan->fdev->dev, "resume chan:%d\n", ch_id);
666 	dev_dbg(fchan->fdev->dev, "terminate chan:%d\n", ch_id);
669 	fdma_write(fchan->fdev, cmd, FDMA_CMD_SET_OFST);
715 			struct st_fdma_dev *fdev)
717 	snprintf(fdev->fw_name, FW_NAME_SIZE, "fdma_%s_%d.elf",
721 				    &fdev->nr_channels);
728 static void st_fdma_free(struct st_fdma_dev *fdev)
733 	for (i = 0; i < fdev->nr_channels; i++) {
734 		fchan = &fdev->chans[i];
742 	struct st_fdma_dev *fdev;
749 	fdev = devm_kzalloc(&pdev->dev, sizeof(*fdev), GFP_KERNEL);
750 	if (!fdev)
753 	ret = st_fdma_parse_dt(pdev, drvdata, fdev);
759 	fdev->chans = devm_kcalloc(&pdev->dev, fdev->nr_channels,
761 	if (!fdev->chans)
764 	fdev->dev = &pdev->dev;
765 	fdev->drvdata = drvdata;
766 	platform_set_drvdata(pdev, fdev);
768 	fdev->irq = platform_get_irq(pdev, 0);
769 	if (fdev->irq < 0)
772 	ret = devm_request_irq(&pdev->dev, fdev->irq, st_fdma_irq_handler, 0,
773 			       dev_name(&pdev->dev), fdev);
779 	fdev->slim_rproc = st_slim_rproc_alloc(pdev, fdev->fw_name);
780 	if (IS_ERR(fdev->slim_rproc)) {
781 		ret = PTR_ERR(fdev->slim_rproc);
787 	INIT_LIST_HEAD(&fdev->dma_device.channels);
788 	for (i = 0; i < fdev->nr_channels; i++) {
789 		struct st_fdma_chan *fchan = &fdev->chans[i];
791 		fchan->fdev = fdev;
793 		vchan_init(&fchan->vchan, &fdev->dma_device);
797 	fdev->dreq_mask = BIT(0) | BIT(31);
799 	dma_cap_set(DMA_SLAVE, fdev->dma_device.cap_mask);
800 	dma_cap_set(DMA_CYCLIC, fdev->dma_device.cap_mask);
801 	dma_cap_set(DMA_MEMCPY, fdev->dma_device.cap_mask);
803 	fdev->dma_device.dev = &pdev->dev;
804 	fdev->dma_device.device_alloc_chan_resources = st_fdma_alloc_chan_res;
805 	fdev->dma_device.device_free_chan_resources = st_fdma_free_chan_res;
806 	fdev->dma_device.device_prep_dma_cyclic	= st_fdma_prep_dma_cyclic;
807 	fdev->dma_device.device_prep_slave_sg = st_fdma_prep_slave_sg;
808 	fdev->dma_device.device_prep_dma_memcpy = st_fdma_prep_dma_memcpy;
809 	fdev->dma_device.device_tx_status = st_fdma_tx_status;
810 	fdev->dma_device.device_issue_pending = st_fdma_issue_pending;
811 	fdev->dma_device.device_terminate_all = st_fdma_terminate_all;
812 	fdev->dma_device.device_config = st_fdma_slave_config;
813 	fdev->dma_device.device_pause = st_fdma_pause;
814 	fdev->dma_device.device_resume = st_fdma_resume;
816 	fdev->dma_device.src_addr_widths = FDMA_DMA_BUSWIDTHS;
817 	fdev->dma_device.dst_addr_widths = FDMA_DMA_BUSWIDTHS;
818 	fdev->dma_device.directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV);
819 	fdev->dma_device.residue_granularity = DMA_RESIDUE_GRANULARITY_BURST;
821 	ret = dmaenginem_async_device_register(&fdev->dma_device);
828 	ret = of_dma_controller_register(np, st_fdma_of_xlate, fdev);
835 	dev_info(&pdev->dev, "ST FDMA engine driver, irq:%d\n", fdev->irq);
840 	st_fdma_free(fdev);
841 	st_slim_rproc_put(fdev->slim_rproc);
848 	struct st_fdma_dev *fdev = platform_get_drvdata(pdev);
850 	devm_free_irq(&pdev->dev, fdev->irq, fdev);
851 	st_slim_rproc_put(fdev->slim_rproc);