xref: /linux/drivers/dma/loongson2-apb-dma.c (revision 23db0ed34f9e3756d243c5dc56d9f7c1fadecf89)
18974f34dSBinbin Zhou // SPDX-License-Identifier: GPL-2.0-or-later
28974f34dSBinbin Zhou /*
38974f34dSBinbin Zhou  * Driver for the Loongson-2 APB DMA Controller
48974f34dSBinbin Zhou  *
58974f34dSBinbin Zhou  * Copyright (C) 2017-2023 Loongson Corporation
68974f34dSBinbin Zhou  */
78974f34dSBinbin Zhou 
88974f34dSBinbin Zhou #include <linux/clk.h>
98974f34dSBinbin Zhou #include <linux/dma-mapping.h>
108974f34dSBinbin Zhou #include <linux/dmapool.h>
118974f34dSBinbin Zhou #include <linux/interrupt.h>
128974f34dSBinbin Zhou #include <linux/io.h>
138974f34dSBinbin Zhou #include <linux/io-64-nonatomic-lo-hi.h>
148974f34dSBinbin Zhou #include <linux/module.h>
158974f34dSBinbin Zhou #include <linux/of.h>
168974f34dSBinbin Zhou #include <linux/of_dma.h>
178974f34dSBinbin Zhou #include <linux/platform_device.h>
188974f34dSBinbin Zhou #include <linux/slab.h>
198974f34dSBinbin Zhou 
208974f34dSBinbin Zhou #include "dmaengine.h"
218974f34dSBinbin Zhou #include "virt-dma.h"
228974f34dSBinbin Zhou 
238974f34dSBinbin Zhou /* Global Configuration Register */
248974f34dSBinbin Zhou #define LDMA_ORDER_ERG		0x0
258974f34dSBinbin Zhou 
268974f34dSBinbin Zhou /* Bitfield definitions */
278974f34dSBinbin Zhou 
288974f34dSBinbin Zhou /* Bitfields in Global Configuration Register */
298974f34dSBinbin Zhou #define LDMA_64BIT_EN		BIT(0) /* 1: 64 bit support */
308974f34dSBinbin Zhou #define LDMA_UNCOHERENT_EN	BIT(1) /* 0: cache, 1: uncache */
318974f34dSBinbin Zhou #define LDMA_ASK_VALID		BIT(2)
328974f34dSBinbin Zhou #define LDMA_START		BIT(3) /* DMA start operation */
338974f34dSBinbin Zhou #define LDMA_STOP		BIT(4) /* DMA stop operation */
34*4b65d532SBinbin Zhou #define LDMA_CONFIG_MASK	GENMASK_ULL(4, 0) /* DMA controller config bits mask */
358974f34dSBinbin Zhou 
368974f34dSBinbin Zhou /* Bitfields in ndesc_addr field of HW descriptor */
378974f34dSBinbin Zhou #define LDMA_DESC_EN		BIT(0) /*1: The next descriptor is valid */
388974f34dSBinbin Zhou #define LDMA_DESC_ADDR_LOW	GENMASK(31, 1)
398974f34dSBinbin Zhou 
408974f34dSBinbin Zhou /* Bitfields in cmd field of HW descriptor */
418974f34dSBinbin Zhou #define LDMA_INT		BIT(1) /* Enable DMA interrupts */
428974f34dSBinbin Zhou #define LDMA_DATA_DIRECTION	BIT(12) /* 1: write to device, 0: read from device */
438974f34dSBinbin Zhou 
448974f34dSBinbin Zhou #define LDMA_SLAVE_BUSWIDTHS	(BIT(DMA_SLAVE_BUSWIDTH_4_BYTES) | \
458974f34dSBinbin Zhou 				 BIT(DMA_SLAVE_BUSWIDTH_8_BYTES))
468974f34dSBinbin Zhou 
478974f34dSBinbin Zhou #define LDMA_MAX_TRANS_LEN	U32_MAX
488974f34dSBinbin Zhou 
498974f34dSBinbin Zhou /*--  descriptors  -----------------------------------------------------*/
508974f34dSBinbin Zhou 
518974f34dSBinbin Zhou /*
528974f34dSBinbin Zhou  * struct ls2x_dma_hw_desc - DMA HW descriptor
538974f34dSBinbin Zhou  * @ndesc_addr: the next descriptor low address.
548974f34dSBinbin Zhou  * @mem_addr: memory low address.
558974f34dSBinbin Zhou  * @apb_addr: device buffer address.
568974f34dSBinbin Zhou  * @len: length of a piece of carried content, in words.
578974f34dSBinbin Zhou  * @step_len: length between two moved memory data blocks.
588974f34dSBinbin Zhou  * @step_times: number of blocks to be carried in a single DMA operation.
598974f34dSBinbin Zhou  * @cmd: descriptor command or state.
608974f34dSBinbin Zhou  * @stats: DMA status.
618974f34dSBinbin Zhou  * @high_ndesc_addr: the next descriptor high address.
628974f34dSBinbin Zhou  * @high_mem_addr: memory high address.
638974f34dSBinbin Zhou  * @reserved: reserved
648974f34dSBinbin Zhou  */
658974f34dSBinbin Zhou struct ls2x_dma_hw_desc {
668974f34dSBinbin Zhou 	u32 ndesc_addr;
678974f34dSBinbin Zhou 	u32 mem_addr;
688974f34dSBinbin Zhou 	u32 apb_addr;
698974f34dSBinbin Zhou 	u32 len;
708974f34dSBinbin Zhou 	u32 step_len;
718974f34dSBinbin Zhou 	u32 step_times;
728974f34dSBinbin Zhou 	u32 cmd;
738974f34dSBinbin Zhou 	u32 stats;
748974f34dSBinbin Zhou 	u32 high_ndesc_addr;
758974f34dSBinbin Zhou 	u32 high_mem_addr;
768974f34dSBinbin Zhou 	u32 reserved[2];
778974f34dSBinbin Zhou } __packed;
788974f34dSBinbin Zhou 
798974f34dSBinbin Zhou /*
808974f34dSBinbin Zhou  * struct ls2x_dma_sg - ls2x dma scatter gather entry
818974f34dSBinbin Zhou  * @hw: the pointer to DMA HW descriptor.
828974f34dSBinbin Zhou  * @llp: physical address of the DMA HW descriptor.
838974f34dSBinbin Zhou  * @phys: destination or source address(mem).
848974f34dSBinbin Zhou  * @len: number of Bytes to read.
858974f34dSBinbin Zhou  */
868974f34dSBinbin Zhou struct ls2x_dma_sg {
878974f34dSBinbin Zhou 	struct ls2x_dma_hw_desc	*hw;
888974f34dSBinbin Zhou 	dma_addr_t		llp;
898974f34dSBinbin Zhou 	dma_addr_t		phys;
908974f34dSBinbin Zhou 	u32			len;
918974f34dSBinbin Zhou };
928974f34dSBinbin Zhou 
938974f34dSBinbin Zhou /*
948974f34dSBinbin Zhou  * struct ls2x_dma_desc - software descriptor
958974f34dSBinbin Zhou  * @vdesc: pointer to the virtual dma descriptor.
968974f34dSBinbin Zhou  * @cyclic: flag to dma cyclic
978974f34dSBinbin Zhou  * @burst_size: burst size of transaction, in words.
988974f34dSBinbin Zhou  * @desc_num: number of sg entries.
998974f34dSBinbin Zhou  * @direction: transfer direction, to or from device.
1008974f34dSBinbin Zhou  * @status: dma controller status.
1018974f34dSBinbin Zhou  * @sg: array of sgs.
1028974f34dSBinbin Zhou  */
1038974f34dSBinbin Zhou struct ls2x_dma_desc {
1048974f34dSBinbin Zhou 	struct virt_dma_desc		vdesc;
1058974f34dSBinbin Zhou 	bool				cyclic;
1068974f34dSBinbin Zhou 	size_t				burst_size;
1078974f34dSBinbin Zhou 	u32				desc_num;
1088974f34dSBinbin Zhou 	enum dma_transfer_direction	direction;
1098974f34dSBinbin Zhou 	enum dma_status			status;
1108974f34dSBinbin Zhou 	struct ls2x_dma_sg		sg[] __counted_by(desc_num);
1118974f34dSBinbin Zhou };
1128974f34dSBinbin Zhou 
1138974f34dSBinbin Zhou /*--  Channels  --------------------------------------------------------*/
1148974f34dSBinbin Zhou 
1158974f34dSBinbin Zhou /*
1168974f34dSBinbin Zhou  * struct ls2x_dma_chan - internal representation of an LS2X APB DMA channel
1178974f34dSBinbin Zhou  * @vchan: virtual dma channel entry.
1188974f34dSBinbin Zhou  * @desc: pointer to the ls2x sw dma descriptor.
1198974f34dSBinbin Zhou  * @pool: hw desc table
1208974f34dSBinbin Zhou  * @irq: irq line
1218974f34dSBinbin Zhou  * @sconfig: configuration for slave transfers, passed via .device_config
1228974f34dSBinbin Zhou  */
1238974f34dSBinbin Zhou struct ls2x_dma_chan {
1248974f34dSBinbin Zhou 	struct virt_dma_chan	vchan;
1258974f34dSBinbin Zhou 	struct ls2x_dma_desc	*desc;
1268974f34dSBinbin Zhou 	void			*pool;
1278974f34dSBinbin Zhou 	int			irq;
1288974f34dSBinbin Zhou 	struct dma_slave_config	sconfig;
1298974f34dSBinbin Zhou };
1308974f34dSBinbin Zhou 
1318974f34dSBinbin Zhou /*--  Controller  ------------------------------------------------------*/
1328974f34dSBinbin Zhou 
1338974f34dSBinbin Zhou /*
1348974f34dSBinbin Zhou  * struct ls2x_dma_priv - LS2X APB DMAC specific information
1358974f34dSBinbin Zhou  * @ddev: dmaengine dma_device object members
1368974f34dSBinbin Zhou  * @dma_clk: DMAC clock source
1378974f34dSBinbin Zhou  * @regs: memory mapped register base
1388974f34dSBinbin Zhou  * @lchan: channel to store ls2x_dma_chan structures
1398974f34dSBinbin Zhou  */
1408974f34dSBinbin Zhou struct ls2x_dma_priv {
1418974f34dSBinbin Zhou 	struct dma_device	ddev;
1428974f34dSBinbin Zhou 	struct clk		*dma_clk;
1438974f34dSBinbin Zhou 	void __iomem		*regs;
1448974f34dSBinbin Zhou 	struct ls2x_dma_chan	lchan;
1458974f34dSBinbin Zhou };
1468974f34dSBinbin Zhou 
1478974f34dSBinbin Zhou /*--  Helper functions  ------------------------------------------------*/
1488974f34dSBinbin Zhou 
to_ldma_desc(struct virt_dma_desc * vdesc)1498974f34dSBinbin Zhou static inline struct ls2x_dma_desc *to_ldma_desc(struct virt_dma_desc *vdesc)
1508974f34dSBinbin Zhou {
1518974f34dSBinbin Zhou 	return container_of(vdesc, struct ls2x_dma_desc, vdesc);
1528974f34dSBinbin Zhou }
1538974f34dSBinbin Zhou 
to_ldma_chan(struct dma_chan * chan)1548974f34dSBinbin Zhou static inline struct ls2x_dma_chan *to_ldma_chan(struct dma_chan *chan)
1558974f34dSBinbin Zhou {
1568974f34dSBinbin Zhou 	return container_of(chan, struct ls2x_dma_chan, vchan.chan);
1578974f34dSBinbin Zhou }
1588974f34dSBinbin Zhou 
to_ldma_priv(struct dma_device * ddev)1598974f34dSBinbin Zhou static inline struct ls2x_dma_priv *to_ldma_priv(struct dma_device *ddev)
1608974f34dSBinbin Zhou {
1618974f34dSBinbin Zhou 	return container_of(ddev, struct ls2x_dma_priv, ddev);
1628974f34dSBinbin Zhou }
1638974f34dSBinbin Zhou 
chan2dev(struct dma_chan * chan)1648974f34dSBinbin Zhou static struct device *chan2dev(struct dma_chan *chan)
1658974f34dSBinbin Zhou {
1668974f34dSBinbin Zhou 	return &chan->dev->device;
1678974f34dSBinbin Zhou }
1688974f34dSBinbin Zhou 
ls2x_dma_desc_free(struct virt_dma_desc * vdesc)1698974f34dSBinbin Zhou static void ls2x_dma_desc_free(struct virt_dma_desc *vdesc)
1708974f34dSBinbin Zhou {
1718974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(vdesc->tx.chan);
1728974f34dSBinbin Zhou 	struct ls2x_dma_desc *desc = to_ldma_desc(vdesc);
1738974f34dSBinbin Zhou 	int i;
1748974f34dSBinbin Zhou 
1758974f34dSBinbin Zhou 	for (i = 0; i < desc->desc_num; i++) {
1768974f34dSBinbin Zhou 		if (desc->sg[i].hw)
1778974f34dSBinbin Zhou 			dma_pool_free(lchan->pool, desc->sg[i].hw,
1788974f34dSBinbin Zhou 				      desc->sg[i].llp);
1798974f34dSBinbin Zhou 	}
1808974f34dSBinbin Zhou 
1818974f34dSBinbin Zhou 	kfree(desc);
1828974f34dSBinbin Zhou }
1838974f34dSBinbin Zhou 
ls2x_dma_write_cmd(struct ls2x_dma_chan * lchan,bool cmd)1848974f34dSBinbin Zhou static void ls2x_dma_write_cmd(struct ls2x_dma_chan *lchan, bool cmd)
1858974f34dSBinbin Zhou {
1868974f34dSBinbin Zhou 	struct ls2x_dma_priv *priv = to_ldma_priv(lchan->vchan.chan.device);
1878974f34dSBinbin Zhou 	u64 val;
1888974f34dSBinbin Zhou 
1898974f34dSBinbin Zhou 	val = lo_hi_readq(priv->regs + LDMA_ORDER_ERG) & ~LDMA_CONFIG_MASK;
1908974f34dSBinbin Zhou 	val |= LDMA_64BIT_EN | cmd;
1918974f34dSBinbin Zhou 	lo_hi_writeq(val, priv->regs + LDMA_ORDER_ERG);
1928974f34dSBinbin Zhou }
1938974f34dSBinbin Zhou 
ls2x_dma_start_transfer(struct ls2x_dma_chan * lchan)1948974f34dSBinbin Zhou static void ls2x_dma_start_transfer(struct ls2x_dma_chan *lchan)
1958974f34dSBinbin Zhou {
1968974f34dSBinbin Zhou 	struct ls2x_dma_priv *priv = to_ldma_priv(lchan->vchan.chan.device);
1978974f34dSBinbin Zhou 	struct ls2x_dma_sg *ldma_sg;
1988974f34dSBinbin Zhou 	struct virt_dma_desc *vdesc;
1998974f34dSBinbin Zhou 	u64 val;
2008974f34dSBinbin Zhou 
2018974f34dSBinbin Zhou 	/* Get the next descriptor */
2028974f34dSBinbin Zhou 	vdesc = vchan_next_desc(&lchan->vchan);
2038974f34dSBinbin Zhou 	if (!vdesc) {
2048974f34dSBinbin Zhou 		lchan->desc = NULL;
2058974f34dSBinbin Zhou 		return;
2068974f34dSBinbin Zhou 	}
2078974f34dSBinbin Zhou 
2088974f34dSBinbin Zhou 	list_del(&vdesc->node);
2098974f34dSBinbin Zhou 	lchan->desc = to_ldma_desc(vdesc);
2108974f34dSBinbin Zhou 	ldma_sg = &lchan->desc->sg[0];
2118974f34dSBinbin Zhou 
2128974f34dSBinbin Zhou 	/* Start DMA */
2138974f34dSBinbin Zhou 	lo_hi_writeq(0, priv->regs + LDMA_ORDER_ERG);
2148974f34dSBinbin Zhou 	val = (ldma_sg->llp & ~LDMA_CONFIG_MASK) | LDMA_64BIT_EN | LDMA_START;
2158974f34dSBinbin Zhou 	lo_hi_writeq(val, priv->regs + LDMA_ORDER_ERG);
2168974f34dSBinbin Zhou }
2178974f34dSBinbin Zhou 
ls2x_dmac_detect_burst(struct ls2x_dma_chan * lchan)2188974f34dSBinbin Zhou static size_t ls2x_dmac_detect_burst(struct ls2x_dma_chan *lchan)
2198974f34dSBinbin Zhou {
2208974f34dSBinbin Zhou 	u32 maxburst, buswidth;
2218974f34dSBinbin Zhou 
2228974f34dSBinbin Zhou 	/* Reject definitely invalid configurations */
2238974f34dSBinbin Zhou 	if ((lchan->sconfig.src_addr_width & LDMA_SLAVE_BUSWIDTHS) &&
2248974f34dSBinbin Zhou 	    (lchan->sconfig.dst_addr_width & LDMA_SLAVE_BUSWIDTHS))
2258974f34dSBinbin Zhou 		return 0;
2268974f34dSBinbin Zhou 
2278974f34dSBinbin Zhou 	if (lchan->sconfig.direction == DMA_MEM_TO_DEV) {
2288974f34dSBinbin Zhou 		maxburst = lchan->sconfig.dst_maxburst;
2298974f34dSBinbin Zhou 		buswidth = lchan->sconfig.dst_addr_width;
2308974f34dSBinbin Zhou 	} else {
2318974f34dSBinbin Zhou 		maxburst = lchan->sconfig.src_maxburst;
2328974f34dSBinbin Zhou 		buswidth = lchan->sconfig.src_addr_width;
2338974f34dSBinbin Zhou 	}
2348974f34dSBinbin Zhou 
2358974f34dSBinbin Zhou 	/* If maxburst is zero, fallback to LDMA_MAX_TRANS_LEN */
2368974f34dSBinbin Zhou 	return maxburst ? (maxburst * buswidth) >> 2 : LDMA_MAX_TRANS_LEN;
2378974f34dSBinbin Zhou }
2388974f34dSBinbin Zhou 
ls2x_dma_fill_desc(struct ls2x_dma_chan * lchan,u32 sg_index,struct ls2x_dma_desc * desc)2398974f34dSBinbin Zhou static void ls2x_dma_fill_desc(struct ls2x_dma_chan *lchan, u32 sg_index,
2408974f34dSBinbin Zhou 			       struct ls2x_dma_desc *desc)
2418974f34dSBinbin Zhou {
2428974f34dSBinbin Zhou 	struct ls2x_dma_sg *ldma_sg = &desc->sg[sg_index];
2438974f34dSBinbin Zhou 	u32 num_segments, segment_size;
2448974f34dSBinbin Zhou 
2458974f34dSBinbin Zhou 	if (desc->direction == DMA_MEM_TO_DEV) {
2468974f34dSBinbin Zhou 		ldma_sg->hw->cmd = LDMA_INT | LDMA_DATA_DIRECTION;
2478974f34dSBinbin Zhou 		ldma_sg->hw->apb_addr = lchan->sconfig.dst_addr;
2488974f34dSBinbin Zhou 	} else {
2498974f34dSBinbin Zhou 		ldma_sg->hw->cmd = LDMA_INT;
2508974f34dSBinbin Zhou 		ldma_sg->hw->apb_addr = lchan->sconfig.src_addr;
2518974f34dSBinbin Zhou 	}
2528974f34dSBinbin Zhou 
2538974f34dSBinbin Zhou 	ldma_sg->hw->mem_addr = lower_32_bits(ldma_sg->phys);
2548974f34dSBinbin Zhou 	ldma_sg->hw->high_mem_addr = upper_32_bits(ldma_sg->phys);
2558974f34dSBinbin Zhou 
2568974f34dSBinbin Zhou 	/* Split into multiple equally sized segments if necessary */
2578974f34dSBinbin Zhou 	num_segments = DIV_ROUND_UP((ldma_sg->len + 3) >> 2, desc->burst_size);
2588974f34dSBinbin Zhou 	segment_size = DIV_ROUND_UP((ldma_sg->len + 3) >> 2, num_segments);
2598974f34dSBinbin Zhou 
2608974f34dSBinbin Zhou 	/* Word count register takes input in words */
2618974f34dSBinbin Zhou 	ldma_sg->hw->len = segment_size;
2628974f34dSBinbin Zhou 	ldma_sg->hw->step_times = num_segments;
2638974f34dSBinbin Zhou 	ldma_sg->hw->step_len = 0;
2648974f34dSBinbin Zhou 
2658974f34dSBinbin Zhou 	/* lets make a link list */
2668974f34dSBinbin Zhou 	if (sg_index) {
2678974f34dSBinbin Zhou 		desc->sg[sg_index - 1].hw->ndesc_addr = ldma_sg->llp | LDMA_DESC_EN;
2688974f34dSBinbin Zhou 		desc->sg[sg_index - 1].hw->high_ndesc_addr = upper_32_bits(ldma_sg->llp);
2698974f34dSBinbin Zhou 	}
2708974f34dSBinbin Zhou }
2718974f34dSBinbin Zhou 
2728974f34dSBinbin Zhou /*--  DMA Engine API  --------------------------------------------------*/
2738974f34dSBinbin Zhou 
2748974f34dSBinbin Zhou /*
2758974f34dSBinbin Zhou  * ls2x_dma_alloc_chan_resources - allocate resources for DMA channel
2768974f34dSBinbin Zhou  * @chan: allocate descriptor resources for this channel
2778974f34dSBinbin Zhou  *
2788974f34dSBinbin Zhou  * return - the number of allocated descriptors
2798974f34dSBinbin Zhou  */
ls2x_dma_alloc_chan_resources(struct dma_chan * chan)2808974f34dSBinbin Zhou static int ls2x_dma_alloc_chan_resources(struct dma_chan *chan)
2818974f34dSBinbin Zhou {
2828974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
2838974f34dSBinbin Zhou 
2848974f34dSBinbin Zhou 	/* Create a pool of consistent memory blocks for hardware descriptors */
2858974f34dSBinbin Zhou 	lchan->pool = dma_pool_create(dev_name(chan2dev(chan)),
2868974f34dSBinbin Zhou 				      chan->device->dev, PAGE_SIZE,
2878974f34dSBinbin Zhou 				      __alignof__(struct ls2x_dma_hw_desc), 0);
2888974f34dSBinbin Zhou 	if (!lchan->pool) {
2898974f34dSBinbin Zhou 		dev_err(chan2dev(chan), "No memory for descriptors\n");
2908974f34dSBinbin Zhou 		return -ENOMEM;
2918974f34dSBinbin Zhou 	}
2928974f34dSBinbin Zhou 
2938974f34dSBinbin Zhou 	return 1;
2948974f34dSBinbin Zhou }
2958974f34dSBinbin Zhou 
2968974f34dSBinbin Zhou /*
2978974f34dSBinbin Zhou  * ls2x_dma_free_chan_resources - free all channel resources
2988974f34dSBinbin Zhou  * @chan: DMA channel
2998974f34dSBinbin Zhou  */
ls2x_dma_free_chan_resources(struct dma_chan * chan)3008974f34dSBinbin Zhou static void ls2x_dma_free_chan_resources(struct dma_chan *chan)
3018974f34dSBinbin Zhou {
3028974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
3038974f34dSBinbin Zhou 
3048974f34dSBinbin Zhou 	vchan_free_chan_resources(to_virt_chan(chan));
3058974f34dSBinbin Zhou 	dma_pool_destroy(lchan->pool);
3068974f34dSBinbin Zhou 	lchan->pool = NULL;
3078974f34dSBinbin Zhou }
3088974f34dSBinbin Zhou 
3098974f34dSBinbin Zhou /*
3108974f34dSBinbin Zhou  * ls2x_dma_prep_slave_sg - prepare descriptors for a DMA_SLAVE transaction
3118974f34dSBinbin Zhou  * @chan: DMA channel
3128974f34dSBinbin Zhou  * @sgl: scatterlist to transfer to/from
3138974f34dSBinbin Zhou  * @sg_len: number of entries in @scatterlist
3148974f34dSBinbin Zhou  * @direction: DMA direction
3158974f34dSBinbin Zhou  * @flags: tx descriptor status flags
3168974f34dSBinbin Zhou  * @context: transaction context (ignored)
3178974f34dSBinbin Zhou  *
3188974f34dSBinbin Zhou  * Return: Async transaction descriptor on success and NULL on failure
3198974f34dSBinbin Zhou  */
3208974f34dSBinbin Zhou static struct dma_async_tx_descriptor *
ls2x_dma_prep_slave_sg(struct dma_chan * chan,struct scatterlist * sgl,u32 sg_len,enum dma_transfer_direction direction,unsigned long flags,void * context)3218974f34dSBinbin Zhou ls2x_dma_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl,
3228974f34dSBinbin Zhou 		       u32 sg_len, enum dma_transfer_direction direction,
3238974f34dSBinbin Zhou 		       unsigned long flags, void *context)
3248974f34dSBinbin Zhou {
3258974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
3268974f34dSBinbin Zhou 	struct ls2x_dma_desc *desc;
3278974f34dSBinbin Zhou 	struct scatterlist *sg;
3288974f34dSBinbin Zhou 	size_t burst_size;
3298974f34dSBinbin Zhou 	int i;
3308974f34dSBinbin Zhou 
3318974f34dSBinbin Zhou 	if (unlikely(!sg_len || !is_slave_direction(direction)))
3328974f34dSBinbin Zhou 		return NULL;
3338974f34dSBinbin Zhou 
3348974f34dSBinbin Zhou 	burst_size = ls2x_dmac_detect_burst(lchan);
3358974f34dSBinbin Zhou 	if (!burst_size)
3368974f34dSBinbin Zhou 		return NULL;
3378974f34dSBinbin Zhou 
3388974f34dSBinbin Zhou 	desc = kzalloc(struct_size(desc, sg, sg_len), GFP_NOWAIT);
3398974f34dSBinbin Zhou 	if (!desc)
3408974f34dSBinbin Zhou 		return NULL;
3418974f34dSBinbin Zhou 
3428974f34dSBinbin Zhou 	desc->desc_num = sg_len;
3438974f34dSBinbin Zhou 	desc->direction = direction;
3448974f34dSBinbin Zhou 	desc->burst_size = burst_size;
3458974f34dSBinbin Zhou 
3468974f34dSBinbin Zhou 	for_each_sg(sgl, sg, sg_len, i) {
3478974f34dSBinbin Zhou 		struct ls2x_dma_sg *ldma_sg = &desc->sg[i];
3488974f34dSBinbin Zhou 
3498974f34dSBinbin Zhou 		/* Allocate DMA capable memory for hardware descriptor */
3508974f34dSBinbin Zhou 		ldma_sg->hw = dma_pool_alloc(lchan->pool, GFP_NOWAIT, &ldma_sg->llp);
3518974f34dSBinbin Zhou 		if (!ldma_sg->hw) {
3528974f34dSBinbin Zhou 			desc->desc_num = i;
3538974f34dSBinbin Zhou 			ls2x_dma_desc_free(&desc->vdesc);
3548974f34dSBinbin Zhou 			return NULL;
3558974f34dSBinbin Zhou 		}
3568974f34dSBinbin Zhou 
3578974f34dSBinbin Zhou 		ldma_sg->phys = sg_dma_address(sg);
3588974f34dSBinbin Zhou 		ldma_sg->len = sg_dma_len(sg);
3598974f34dSBinbin Zhou 
3608974f34dSBinbin Zhou 		ls2x_dma_fill_desc(lchan, i, desc);
3618974f34dSBinbin Zhou 	}
3628974f34dSBinbin Zhou 
3638974f34dSBinbin Zhou 	/* Setting the last descriptor enable bit */
3648974f34dSBinbin Zhou 	desc->sg[sg_len - 1].hw->ndesc_addr &= ~LDMA_DESC_EN;
3658974f34dSBinbin Zhou 	desc->status = DMA_IN_PROGRESS;
3668974f34dSBinbin Zhou 
3678974f34dSBinbin Zhou 	return vchan_tx_prep(&lchan->vchan, &desc->vdesc, flags);
3688974f34dSBinbin Zhou }
3698974f34dSBinbin Zhou 
3708974f34dSBinbin Zhou /*
3718974f34dSBinbin Zhou  * ls2x_dma_prep_dma_cyclic - prepare the cyclic DMA transfer
3728974f34dSBinbin Zhou  * @chan: the DMA channel to prepare
3738974f34dSBinbin Zhou  * @buf_addr: physical DMA address where the buffer starts
3748974f34dSBinbin Zhou  * @buf_len: total number of bytes for the entire buffer
3758974f34dSBinbin Zhou  * @period_len: number of bytes for each period
3768974f34dSBinbin Zhou  * @direction: transfer direction, to or from device
3778974f34dSBinbin Zhou  * @flags: tx descriptor status flags
3788974f34dSBinbin Zhou  *
3798974f34dSBinbin Zhou  * Return: Async transaction descriptor on success and NULL on failure
3808974f34dSBinbin Zhou  */
3818974f34dSBinbin Zhou static struct dma_async_tx_descriptor *
ls2x_dma_prep_dma_cyclic(struct dma_chan * chan,dma_addr_t buf_addr,size_t buf_len,size_t period_len,enum dma_transfer_direction direction,unsigned long flags)3828974f34dSBinbin Zhou ls2x_dma_prep_dma_cyclic(struct dma_chan *chan, dma_addr_t buf_addr, size_t buf_len,
3838974f34dSBinbin Zhou 			 size_t period_len, enum dma_transfer_direction direction,
3848974f34dSBinbin Zhou 			 unsigned long flags)
3858974f34dSBinbin Zhou {
3868974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
3878974f34dSBinbin Zhou 	struct ls2x_dma_desc *desc;
3888974f34dSBinbin Zhou 	size_t burst_size;
3898974f34dSBinbin Zhou 	u32 num_periods;
3908974f34dSBinbin Zhou 	int i;
3918974f34dSBinbin Zhou 
3928974f34dSBinbin Zhou 	if (unlikely(!buf_len || !period_len))
3938974f34dSBinbin Zhou 		return NULL;
3948974f34dSBinbin Zhou 
3958974f34dSBinbin Zhou 	if (unlikely(!is_slave_direction(direction)))
3968974f34dSBinbin Zhou 		return NULL;
3978974f34dSBinbin Zhou 
3988974f34dSBinbin Zhou 	burst_size = ls2x_dmac_detect_burst(lchan);
3998974f34dSBinbin Zhou 	if (!burst_size)
4008974f34dSBinbin Zhou 		return NULL;
4018974f34dSBinbin Zhou 
4028974f34dSBinbin Zhou 	num_periods = buf_len / period_len;
4038974f34dSBinbin Zhou 	desc = kzalloc(struct_size(desc, sg, num_periods), GFP_NOWAIT);
4048974f34dSBinbin Zhou 	if (!desc)
4058974f34dSBinbin Zhou 		return NULL;
4068974f34dSBinbin Zhou 
4078974f34dSBinbin Zhou 	desc->desc_num = num_periods;
4088974f34dSBinbin Zhou 	desc->direction = direction;
4098974f34dSBinbin Zhou 	desc->burst_size = burst_size;
4108974f34dSBinbin Zhou 
4118974f34dSBinbin Zhou 	/* Build cyclic linked list */
4128974f34dSBinbin Zhou 	for (i = 0; i < num_periods; i++) {
4138974f34dSBinbin Zhou 		struct ls2x_dma_sg *ldma_sg = &desc->sg[i];
4148974f34dSBinbin Zhou 
4158974f34dSBinbin Zhou 		/* Allocate DMA capable memory for hardware descriptor */
4168974f34dSBinbin Zhou 		ldma_sg->hw = dma_pool_alloc(lchan->pool, GFP_NOWAIT, &ldma_sg->llp);
4178974f34dSBinbin Zhou 		if (!ldma_sg->hw) {
4188974f34dSBinbin Zhou 			desc->desc_num = i;
4198974f34dSBinbin Zhou 			ls2x_dma_desc_free(&desc->vdesc);
4208974f34dSBinbin Zhou 			return NULL;
4218974f34dSBinbin Zhou 		}
4228974f34dSBinbin Zhou 
4238974f34dSBinbin Zhou 		ldma_sg->phys = buf_addr + period_len * i;
4248974f34dSBinbin Zhou 		ldma_sg->len = period_len;
4258974f34dSBinbin Zhou 
4268974f34dSBinbin Zhou 		ls2x_dma_fill_desc(lchan, i, desc);
4278974f34dSBinbin Zhou 	}
4288974f34dSBinbin Zhou 
4298974f34dSBinbin Zhou 	/* Lets make a cyclic list */
4308974f34dSBinbin Zhou 	desc->sg[num_periods - 1].hw->ndesc_addr = desc->sg[0].llp | LDMA_DESC_EN;
4318974f34dSBinbin Zhou 	desc->sg[num_periods - 1].hw->high_ndesc_addr = upper_32_bits(desc->sg[0].llp);
4328974f34dSBinbin Zhou 	desc->cyclic = true;
4338974f34dSBinbin Zhou 	desc->status = DMA_IN_PROGRESS;
4348974f34dSBinbin Zhou 
4358974f34dSBinbin Zhou 	return vchan_tx_prep(&lchan->vchan, &desc->vdesc, flags);
4368974f34dSBinbin Zhou }
4378974f34dSBinbin Zhou 
4388974f34dSBinbin Zhou /*
4398974f34dSBinbin Zhou  * ls2x_slave_config - set slave configuration for channel
4408974f34dSBinbin Zhou  * @chan: dma channel
4418974f34dSBinbin Zhou  * @cfg: slave configuration
4428974f34dSBinbin Zhou  *
4438974f34dSBinbin Zhou  * Sets slave configuration for channel
4448974f34dSBinbin Zhou  */
ls2x_dma_slave_config(struct dma_chan * chan,struct dma_slave_config * config)4458974f34dSBinbin Zhou static int ls2x_dma_slave_config(struct dma_chan *chan,
4468974f34dSBinbin Zhou 				 struct dma_slave_config *config)
4478974f34dSBinbin Zhou {
4488974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
4498974f34dSBinbin Zhou 
4508974f34dSBinbin Zhou 	memcpy(&lchan->sconfig, config, sizeof(*config));
4518974f34dSBinbin Zhou 	return 0;
4528974f34dSBinbin Zhou }
4538974f34dSBinbin Zhou 
4548974f34dSBinbin Zhou /*
4558974f34dSBinbin Zhou  * ls2x_dma_issue_pending - push pending transactions to the hardware
4568974f34dSBinbin Zhou  * @chan: channel
4578974f34dSBinbin Zhou  *
4588974f34dSBinbin Zhou  * When this function is called, all pending transactions are pushed to the
4598974f34dSBinbin Zhou  * hardware and executed.
4608974f34dSBinbin Zhou  */
ls2x_dma_issue_pending(struct dma_chan * chan)4618974f34dSBinbin Zhou static void ls2x_dma_issue_pending(struct dma_chan *chan)
4628974f34dSBinbin Zhou {
4638974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
4648974f34dSBinbin Zhou 	unsigned long flags;
4658974f34dSBinbin Zhou 
4668974f34dSBinbin Zhou 	spin_lock_irqsave(&lchan->vchan.lock, flags);
4678974f34dSBinbin Zhou 	if (vchan_issue_pending(&lchan->vchan) && !lchan->desc)
4688974f34dSBinbin Zhou 		ls2x_dma_start_transfer(lchan);
4698974f34dSBinbin Zhou 	spin_unlock_irqrestore(&lchan->vchan.lock, flags);
4708974f34dSBinbin Zhou }
4718974f34dSBinbin Zhou 
4728974f34dSBinbin Zhou /*
4738974f34dSBinbin Zhou  * ls2x_dma_terminate_all - terminate all transactions
4748974f34dSBinbin Zhou  * @chan: channel
4758974f34dSBinbin Zhou  *
4768974f34dSBinbin Zhou  * Stops all DMA transactions.
4778974f34dSBinbin Zhou  */
ls2x_dma_terminate_all(struct dma_chan * chan)4788974f34dSBinbin Zhou static int ls2x_dma_terminate_all(struct dma_chan *chan)
4798974f34dSBinbin Zhou {
4808974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
4818974f34dSBinbin Zhou 	unsigned long flags;
4828974f34dSBinbin Zhou 	LIST_HEAD(head);
4838974f34dSBinbin Zhou 
4848974f34dSBinbin Zhou 	spin_lock_irqsave(&lchan->vchan.lock, flags);
4858974f34dSBinbin Zhou 	/* Setting stop cmd */
4868974f34dSBinbin Zhou 	ls2x_dma_write_cmd(lchan, LDMA_STOP);
4878974f34dSBinbin Zhou 	if (lchan->desc) {
4888974f34dSBinbin Zhou 		vchan_terminate_vdesc(&lchan->desc->vdesc);
4898974f34dSBinbin Zhou 		lchan->desc = NULL;
4908974f34dSBinbin Zhou 	}
4918974f34dSBinbin Zhou 
4928974f34dSBinbin Zhou 	vchan_get_all_descriptors(&lchan->vchan, &head);
4938974f34dSBinbin Zhou 	spin_unlock_irqrestore(&lchan->vchan.lock, flags);
4948974f34dSBinbin Zhou 
4958974f34dSBinbin Zhou 	vchan_dma_desc_free_list(&lchan->vchan, &head);
4968974f34dSBinbin Zhou 	return 0;
4978974f34dSBinbin Zhou }
4988974f34dSBinbin Zhou 
4998974f34dSBinbin Zhou /*
5008974f34dSBinbin Zhou  * ls2x_dma_synchronize - Synchronizes the termination of transfers to the
5018974f34dSBinbin Zhou  * current context.
5028974f34dSBinbin Zhou  * @chan: channel
5038974f34dSBinbin Zhou  */
ls2x_dma_synchronize(struct dma_chan * chan)5048974f34dSBinbin Zhou static void ls2x_dma_synchronize(struct dma_chan *chan)
5058974f34dSBinbin Zhou {
5068974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
5078974f34dSBinbin Zhou 
5088974f34dSBinbin Zhou 	vchan_synchronize(&lchan->vchan);
5098974f34dSBinbin Zhou }
5108974f34dSBinbin Zhou 
ls2x_dma_pause(struct dma_chan * chan)5118974f34dSBinbin Zhou static int ls2x_dma_pause(struct dma_chan *chan)
5128974f34dSBinbin Zhou {
5138974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
5148974f34dSBinbin Zhou 	unsigned long flags;
5158974f34dSBinbin Zhou 
5168974f34dSBinbin Zhou 	spin_lock_irqsave(&lchan->vchan.lock, flags);
5178974f34dSBinbin Zhou 	if (lchan->desc && lchan->desc->status == DMA_IN_PROGRESS) {
5188974f34dSBinbin Zhou 		ls2x_dma_write_cmd(lchan, LDMA_STOP);
5198974f34dSBinbin Zhou 		lchan->desc->status = DMA_PAUSED;
5208974f34dSBinbin Zhou 	}
5218974f34dSBinbin Zhou 	spin_unlock_irqrestore(&lchan->vchan.lock, flags);
5228974f34dSBinbin Zhou 
5238974f34dSBinbin Zhou 	return 0;
5248974f34dSBinbin Zhou }
5258974f34dSBinbin Zhou 
ls2x_dma_resume(struct dma_chan * chan)5268974f34dSBinbin Zhou static int ls2x_dma_resume(struct dma_chan *chan)
5278974f34dSBinbin Zhou {
5288974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan);
5298974f34dSBinbin Zhou 	unsigned long flags;
5308974f34dSBinbin Zhou 
5318974f34dSBinbin Zhou 	spin_lock_irqsave(&lchan->vchan.lock, flags);
5328974f34dSBinbin Zhou 	if (lchan->desc && lchan->desc->status == DMA_PAUSED) {
5338974f34dSBinbin Zhou 		lchan->desc->status = DMA_IN_PROGRESS;
5348974f34dSBinbin Zhou 		ls2x_dma_write_cmd(lchan, LDMA_START);
5358974f34dSBinbin Zhou 	}
5368974f34dSBinbin Zhou 	spin_unlock_irqrestore(&lchan->vchan.lock, flags);
5378974f34dSBinbin Zhou 
5388974f34dSBinbin Zhou 	return 0;
5398974f34dSBinbin Zhou }
5408974f34dSBinbin Zhou 
5418974f34dSBinbin Zhou /*
5428974f34dSBinbin Zhou  * ls2x_dma_isr - LS2X DMA Interrupt handler
5438974f34dSBinbin Zhou  * @irq: IRQ number
5448974f34dSBinbin Zhou  * @dev_id: Pointer to ls2x_dma_chan
5458974f34dSBinbin Zhou  *
5468974f34dSBinbin Zhou  * Return: IRQ_HANDLED/IRQ_NONE
5478974f34dSBinbin Zhou  */
ls2x_dma_isr(int irq,void * dev_id)5488974f34dSBinbin Zhou static irqreturn_t ls2x_dma_isr(int irq, void *dev_id)
5498974f34dSBinbin Zhou {
5508974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = dev_id;
5518974f34dSBinbin Zhou 	struct ls2x_dma_desc *desc;
5528974f34dSBinbin Zhou 
5538974f34dSBinbin Zhou 	spin_lock(&lchan->vchan.lock);
5548974f34dSBinbin Zhou 	desc = lchan->desc;
5558974f34dSBinbin Zhou 	if (desc) {
5568974f34dSBinbin Zhou 		if (desc->cyclic) {
5578974f34dSBinbin Zhou 			vchan_cyclic_callback(&desc->vdesc);
5588974f34dSBinbin Zhou 		} else {
5598974f34dSBinbin Zhou 			desc->status = DMA_COMPLETE;
5608974f34dSBinbin Zhou 			vchan_cookie_complete(&desc->vdesc);
5618974f34dSBinbin Zhou 			ls2x_dma_start_transfer(lchan);
5628974f34dSBinbin Zhou 		}
5638974f34dSBinbin Zhou 
5648974f34dSBinbin Zhou 		/* ls2x_dma_start_transfer() updates lchan->desc */
5658974f34dSBinbin Zhou 		if (!lchan->desc)
5668974f34dSBinbin Zhou 			ls2x_dma_write_cmd(lchan, LDMA_STOP);
5678974f34dSBinbin Zhou 	}
5688974f34dSBinbin Zhou 	spin_unlock(&lchan->vchan.lock);
5698974f34dSBinbin Zhou 
5708974f34dSBinbin Zhou 	return IRQ_HANDLED;
5718974f34dSBinbin Zhou }
5728974f34dSBinbin Zhou 
ls2x_dma_chan_init(struct platform_device * pdev,struct ls2x_dma_priv * priv)5738974f34dSBinbin Zhou static int ls2x_dma_chan_init(struct platform_device *pdev,
5748974f34dSBinbin Zhou 			      struct ls2x_dma_priv *priv)
5758974f34dSBinbin Zhou {
5768974f34dSBinbin Zhou 	struct ls2x_dma_chan *lchan = &priv->lchan;
5778974f34dSBinbin Zhou 	struct device *dev = &pdev->dev;
5788974f34dSBinbin Zhou 	int ret;
5798974f34dSBinbin Zhou 
5808974f34dSBinbin Zhou 	lchan->irq = platform_get_irq(pdev, 0);
5818974f34dSBinbin Zhou 	if (lchan->irq < 0)
5828974f34dSBinbin Zhou 		return lchan->irq;
5838974f34dSBinbin Zhou 
5848974f34dSBinbin Zhou 	ret = devm_request_irq(dev, lchan->irq, ls2x_dma_isr, IRQF_TRIGGER_RISING,
5858974f34dSBinbin Zhou 			       dev_name(&pdev->dev), lchan);
5868974f34dSBinbin Zhou 	if (ret)
5878974f34dSBinbin Zhou 		return ret;
5888974f34dSBinbin Zhou 
5898974f34dSBinbin Zhou 	/* Initialize channels related values */
5908974f34dSBinbin Zhou 	INIT_LIST_HEAD(&priv->ddev.channels);
5918974f34dSBinbin Zhou 	lchan->vchan.desc_free = ls2x_dma_desc_free;
5928974f34dSBinbin Zhou 	vchan_init(&lchan->vchan, &priv->ddev);
5938974f34dSBinbin Zhou 
5948974f34dSBinbin Zhou 	return 0;
5958974f34dSBinbin Zhou }
5968974f34dSBinbin Zhou 
5978974f34dSBinbin Zhou /*
5988974f34dSBinbin Zhou  * ls2x_dma_probe - Driver probe function
5998974f34dSBinbin Zhou  * @pdev: Pointer to the platform_device structure
6008974f34dSBinbin Zhou  *
6018974f34dSBinbin Zhou  * Return: '0' on success and failure value on error
6028974f34dSBinbin Zhou  */
ls2x_dma_probe(struct platform_device * pdev)6038974f34dSBinbin Zhou static int ls2x_dma_probe(struct platform_device *pdev)
6048974f34dSBinbin Zhou {
6058974f34dSBinbin Zhou 	struct device *dev = &pdev->dev;
6068974f34dSBinbin Zhou 	struct ls2x_dma_priv *priv;
6078974f34dSBinbin Zhou 	struct dma_device *ddev;
6088974f34dSBinbin Zhou 	int ret;
6098974f34dSBinbin Zhou 
6108974f34dSBinbin Zhou 	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
6118974f34dSBinbin Zhou 	if (!priv)
6128974f34dSBinbin Zhou 		return -ENOMEM;
6138974f34dSBinbin Zhou 
6148974f34dSBinbin Zhou 	priv->regs = devm_platform_ioremap_resource(pdev, 0);
6158974f34dSBinbin Zhou 	if (IS_ERR(priv->regs))
6168974f34dSBinbin Zhou 		return dev_err_probe(dev, PTR_ERR(priv->regs),
6178974f34dSBinbin Zhou 				     "devm_platform_ioremap_resource failed.\n");
6188974f34dSBinbin Zhou 
6198974f34dSBinbin Zhou 	priv->dma_clk = devm_clk_get(&pdev->dev, NULL);
6208974f34dSBinbin Zhou 	if (IS_ERR(priv->dma_clk))
6218974f34dSBinbin Zhou 		return dev_err_probe(dev, PTR_ERR(priv->dma_clk), "devm_clk_get failed.\n");
6228974f34dSBinbin Zhou 
6238974f34dSBinbin Zhou 	ret = clk_prepare_enable(priv->dma_clk);
6248974f34dSBinbin Zhou 	if (ret)
6258974f34dSBinbin Zhou 		return dev_err_probe(dev, ret, "clk_prepare_enable failed.\n");
6268974f34dSBinbin Zhou 
6278974f34dSBinbin Zhou 	ret = ls2x_dma_chan_init(pdev, priv);
6288974f34dSBinbin Zhou 	if (ret)
6298974f34dSBinbin Zhou 		goto disable_clk;
6308974f34dSBinbin Zhou 
6318974f34dSBinbin Zhou 	ddev = &priv->ddev;
6328974f34dSBinbin Zhou 	ddev->dev = dev;
6338974f34dSBinbin Zhou 	dma_cap_zero(ddev->cap_mask);
6348974f34dSBinbin Zhou 	dma_cap_set(DMA_SLAVE, ddev->cap_mask);
6358974f34dSBinbin Zhou 	dma_cap_set(DMA_CYCLIC, ddev->cap_mask);
6368974f34dSBinbin Zhou 
6378974f34dSBinbin Zhou 	ddev->device_alloc_chan_resources = ls2x_dma_alloc_chan_resources;
6388974f34dSBinbin Zhou 	ddev->device_free_chan_resources = ls2x_dma_free_chan_resources;
6398974f34dSBinbin Zhou 	ddev->device_tx_status = dma_cookie_status;
6408974f34dSBinbin Zhou 	ddev->device_issue_pending = ls2x_dma_issue_pending;
6418974f34dSBinbin Zhou 	ddev->device_prep_slave_sg = ls2x_dma_prep_slave_sg;
6428974f34dSBinbin Zhou 	ddev->device_prep_dma_cyclic = ls2x_dma_prep_dma_cyclic;
6438974f34dSBinbin Zhou 	ddev->device_config = ls2x_dma_slave_config;
6448974f34dSBinbin Zhou 	ddev->device_terminate_all = ls2x_dma_terminate_all;
6458974f34dSBinbin Zhou 	ddev->device_synchronize = ls2x_dma_synchronize;
6468974f34dSBinbin Zhou 	ddev->device_pause = ls2x_dma_pause;
6478974f34dSBinbin Zhou 	ddev->device_resume = ls2x_dma_resume;
6488974f34dSBinbin Zhou 
6498974f34dSBinbin Zhou 	ddev->src_addr_widths = LDMA_SLAVE_BUSWIDTHS;
6508974f34dSBinbin Zhou 	ddev->dst_addr_widths = LDMA_SLAVE_BUSWIDTHS;
6518974f34dSBinbin Zhou 	ddev->directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV);
6528974f34dSBinbin Zhou 
6538974f34dSBinbin Zhou 	ret = dma_async_device_register(&priv->ddev);
6548974f34dSBinbin Zhou 	if (ret < 0)
6558974f34dSBinbin Zhou 		goto disable_clk;
6568974f34dSBinbin Zhou 
6578974f34dSBinbin Zhou 	ret = of_dma_controller_register(dev->of_node, of_dma_xlate_by_chan_id, priv);
6588974f34dSBinbin Zhou 	if (ret < 0)
6598974f34dSBinbin Zhou 		goto unregister_dmac;
6608974f34dSBinbin Zhou 
6618974f34dSBinbin Zhou 	platform_set_drvdata(pdev, priv);
6628974f34dSBinbin Zhou 
6638974f34dSBinbin Zhou 	dev_info(dev, "Loongson LS2X APB DMA driver registered successfully.\n");
6648974f34dSBinbin Zhou 	return 0;
6658974f34dSBinbin Zhou 
6668974f34dSBinbin Zhou unregister_dmac:
6678974f34dSBinbin Zhou 	dma_async_device_unregister(&priv->ddev);
6688974f34dSBinbin Zhou disable_clk:
6698974f34dSBinbin Zhou 	clk_disable_unprepare(priv->dma_clk);
6708974f34dSBinbin Zhou 
6718974f34dSBinbin Zhou 	return ret;
6728974f34dSBinbin Zhou }
6738974f34dSBinbin Zhou 
6748974f34dSBinbin Zhou /*
6758974f34dSBinbin Zhou  * ls2x_dma_remove - Driver remove function
6768974f34dSBinbin Zhou  * @pdev: Pointer to the platform_device structure
6778974f34dSBinbin Zhou  */
ls2x_dma_remove(struct platform_device * pdev)6788974f34dSBinbin Zhou static void ls2x_dma_remove(struct platform_device *pdev)
6798974f34dSBinbin Zhou {
6808974f34dSBinbin Zhou 	struct ls2x_dma_priv *priv = platform_get_drvdata(pdev);
6818974f34dSBinbin Zhou 
6828974f34dSBinbin Zhou 	of_dma_controller_free(pdev->dev.of_node);
6838974f34dSBinbin Zhou 	dma_async_device_unregister(&priv->ddev);
6848974f34dSBinbin Zhou 	clk_disable_unprepare(priv->dma_clk);
6858974f34dSBinbin Zhou }
6868974f34dSBinbin Zhou 
6878974f34dSBinbin Zhou static const struct of_device_id ls2x_dma_of_match_table[] = {
6888974f34dSBinbin Zhou 	{ .compatible = "loongson,ls2k1000-apbdma" },
6898974f34dSBinbin Zhou 	{ /* sentinel */ }
6908974f34dSBinbin Zhou };
6918974f34dSBinbin Zhou MODULE_DEVICE_TABLE(of, ls2x_dma_of_match_table);
6928974f34dSBinbin Zhou 
6938974f34dSBinbin Zhou static struct platform_driver ls2x_dmac_driver = {
6948974f34dSBinbin Zhou 	.probe		= ls2x_dma_probe,
6958974f34dSBinbin Zhou 	.remove		= ls2x_dma_remove,
6968974f34dSBinbin Zhou 	.driver = {
6978974f34dSBinbin Zhou 		.name	= "ls2x-apbdma",
6988974f34dSBinbin Zhou 		.of_match_table	= ls2x_dma_of_match_table,
6998974f34dSBinbin Zhou 	},
7008974f34dSBinbin Zhou };
7018974f34dSBinbin Zhou module_platform_driver(ls2x_dmac_driver);
7028974f34dSBinbin Zhou 
7038974f34dSBinbin Zhou MODULE_DESCRIPTION("Loongson-2 APB DMA Controller driver");
7048974f34dSBinbin Zhou MODULE_AUTHOR("Loongson Technology Corporation Limited");
7058974f34dSBinbin Zhou MODULE_LICENSE("GPL");
706