| // SPDX-License-Identifier: GPL-2.0-or-later | 
 | /* | 
 |  * Driver for the Loongson LS2X APB DMA Controller | 
 |  * | 
 |  * Copyright (C) 2017-2023 Loongson Corporation | 
 |  */ | 
 |  | 
 | #include <linux/clk.h> | 
 | #include <linux/dma-mapping.h> | 
 | #include <linux/dmapool.h> | 
 | #include <linux/interrupt.h> | 
 | #include <linux/io.h> | 
 | #include <linux/io-64-nonatomic-lo-hi.h> | 
 | #include <linux/module.h> | 
 | #include <linux/of.h> | 
 | #include <linux/of_dma.h> | 
 | #include <linux/platform_device.h> | 
 | #include <linux/slab.h> | 
 |  | 
 | #include "dmaengine.h" | 
 | #include "virt-dma.h" | 
 |  | 
 | /* Global Configuration Register */ | 
 | #define LDMA_ORDER_ERG		0x0 | 
 |  | 
 | /* Bitfield definitions */ | 
 |  | 
 | /* Bitfields in Global Configuration Register */ | 
 | #define LDMA_64BIT_EN		BIT(0) /* 1: 64 bit support */ | 
 | #define LDMA_UNCOHERENT_EN	BIT(1) /* 0: cache, 1: uncache */ | 
 | #define LDMA_ASK_VALID		BIT(2) | 
 | #define LDMA_START		BIT(3) /* DMA start operation */ | 
 | #define LDMA_STOP		BIT(4) /* DMA stop operation */ | 
 | #define LDMA_CONFIG_MASK	GENMASK(4, 0) /* DMA controller config bits mask */ | 
 |  | 
 | /* Bitfields in ndesc_addr field of HW decriptor */ | 
 | #define LDMA_DESC_EN		BIT(0) /*1: The next descriptor is valid */ | 
 | #define LDMA_DESC_ADDR_LOW	GENMASK(31, 1) | 
 |  | 
 | /* Bitfields in cmd field of HW decriptor */ | 
 | #define LDMA_INT		BIT(1) /* Enable DMA interrupts */ | 
 | #define LDMA_DATA_DIRECTION	BIT(12) /* 1: write to device, 0: read from device */ | 
 |  | 
 | #define LDMA_SLAVE_BUSWIDTHS	(BIT(DMA_SLAVE_BUSWIDTH_4_BYTES) | \ | 
 | 				 BIT(DMA_SLAVE_BUSWIDTH_8_BYTES)) | 
 |  | 
 | #define LDMA_MAX_TRANS_LEN	U32_MAX | 
 |  | 
 | /*--  descriptors  -----------------------------------------------------*/ | 
 |  | 
 | /* | 
 |  * struct ls2x_dma_hw_desc - DMA HW descriptor | 
 |  * @ndesc_addr: the next descriptor low address. | 
 |  * @mem_addr: memory low address. | 
 |  * @apb_addr: device buffer address. | 
 |  * @len: length of a piece of carried content, in words. | 
 |  * @step_len: length between two moved memory data blocks. | 
 |  * @step_times: number of blocks to be carried in a single DMA operation. | 
 |  * @cmd: descriptor command or state. | 
 |  * @stats: DMA status. | 
 |  * @high_ndesc_addr: the next descriptor high address. | 
 |  * @high_mem_addr: memory high address. | 
 |  * @reserved: reserved | 
 |  */ | 
 | struct ls2x_dma_hw_desc { | 
 | 	u32 ndesc_addr; | 
 | 	u32 mem_addr; | 
 | 	u32 apb_addr; | 
 | 	u32 len; | 
 | 	u32 step_len; | 
 | 	u32 step_times; | 
 | 	u32 cmd; | 
 | 	u32 stats; | 
 | 	u32 high_ndesc_addr; | 
 | 	u32 high_mem_addr; | 
 | 	u32 reserved[2]; | 
 | } __packed; | 
 |  | 
 | /* | 
 |  * struct ls2x_dma_sg - ls2x dma scatter gather entry | 
 |  * @hw: the pointer to DMA HW descriptor. | 
 |  * @llp: physical address of the DMA HW descriptor. | 
 |  * @phys: destination or source address(mem). | 
 |  * @len: number of Bytes to read. | 
 |  */ | 
 | struct ls2x_dma_sg { | 
 | 	struct ls2x_dma_hw_desc	*hw; | 
 | 	dma_addr_t		llp; | 
 | 	dma_addr_t		phys; | 
 | 	u32			len; | 
 | }; | 
 |  | 
 | /* | 
 |  * struct ls2x_dma_desc - software descriptor | 
 |  * @vdesc: pointer to the virtual dma descriptor. | 
 |  * @cyclic: flag to dma cyclic | 
 |  * @burst_size: burst size of transaction, in words. | 
 |  * @desc_num: number of sg entries. | 
 |  * @direction: transfer direction, to or from device. | 
 |  * @status: dma controller status. | 
 |  * @sg: array of sgs. | 
 |  */ | 
 | struct ls2x_dma_desc { | 
 | 	struct virt_dma_desc		vdesc; | 
 | 	bool				cyclic; | 
 | 	size_t				burst_size; | 
 | 	u32				desc_num; | 
 | 	enum dma_transfer_direction	direction; | 
 | 	enum dma_status			status; | 
 | 	struct ls2x_dma_sg		sg[] __counted_by(desc_num); | 
 | }; | 
 |  | 
 | /*--  Channels  --------------------------------------------------------*/ | 
 |  | 
 | /* | 
 |  * struct ls2x_dma_chan - internal representation of an LS2X APB DMA channel | 
 |  * @vchan: virtual dma channel entry. | 
 |  * @desc: pointer to the ls2x sw dma descriptor. | 
 |  * @pool: hw desc table | 
 |  * @irq: irq line | 
 |  * @sconfig: configuration for slave transfers, passed via .device_config | 
 |  */ | 
 | struct ls2x_dma_chan { | 
 | 	struct virt_dma_chan	vchan; | 
 | 	struct ls2x_dma_desc	*desc; | 
 | 	void			*pool; | 
 | 	int			irq; | 
 | 	struct dma_slave_config	sconfig; | 
 | }; | 
 |  | 
 | /*--  Controller  ------------------------------------------------------*/ | 
 |  | 
 | /* | 
 |  * struct ls2x_dma_priv - LS2X APB DMAC specific information | 
 |  * @ddev: dmaengine dma_device object members | 
 |  * @dma_clk: DMAC clock source | 
 |  * @regs: memory mapped register base | 
 |  * @lchan: channel to store ls2x_dma_chan structures | 
 |  */ | 
 | struct ls2x_dma_priv { | 
 | 	struct dma_device	ddev; | 
 | 	struct clk		*dma_clk; | 
 | 	void __iomem		*regs; | 
 | 	struct ls2x_dma_chan	lchan; | 
 | }; | 
 |  | 
 | /*--  Helper functions  ------------------------------------------------*/ | 
 |  | 
 | static inline struct ls2x_dma_desc *to_ldma_desc(struct virt_dma_desc *vdesc) | 
 | { | 
 | 	return container_of(vdesc, struct ls2x_dma_desc, vdesc); | 
 | } | 
 |  | 
 | static inline struct ls2x_dma_chan *to_ldma_chan(struct dma_chan *chan) | 
 | { | 
 | 	return container_of(chan, struct ls2x_dma_chan, vchan.chan); | 
 | } | 
 |  | 
 | static inline struct ls2x_dma_priv *to_ldma_priv(struct dma_device *ddev) | 
 | { | 
 | 	return container_of(ddev, struct ls2x_dma_priv, ddev); | 
 | } | 
 |  | 
 | static struct device *chan2dev(struct dma_chan *chan) | 
 | { | 
 | 	return &chan->dev->device; | 
 | } | 
 |  | 
 | static void ls2x_dma_desc_free(struct virt_dma_desc *vdesc) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(vdesc->tx.chan); | 
 | 	struct ls2x_dma_desc *desc = to_ldma_desc(vdesc); | 
 | 	int i; | 
 |  | 
 | 	for (i = 0; i < desc->desc_num; i++) { | 
 | 		if (desc->sg[i].hw) | 
 | 			dma_pool_free(lchan->pool, desc->sg[i].hw, | 
 | 				      desc->sg[i].llp); | 
 | 	} | 
 |  | 
 | 	kfree(desc); | 
 | } | 
 |  | 
 | static void ls2x_dma_write_cmd(struct ls2x_dma_chan *lchan, bool cmd) | 
 | { | 
 | 	struct ls2x_dma_priv *priv = to_ldma_priv(lchan->vchan.chan.device); | 
 | 	u64 val; | 
 |  | 
 | 	val = lo_hi_readq(priv->regs + LDMA_ORDER_ERG) & ~LDMA_CONFIG_MASK; | 
 | 	val |= LDMA_64BIT_EN | cmd; | 
 | 	lo_hi_writeq(val, priv->regs + LDMA_ORDER_ERG); | 
 | } | 
 |  | 
 | static void ls2x_dma_start_transfer(struct ls2x_dma_chan *lchan) | 
 | { | 
 | 	struct ls2x_dma_priv *priv = to_ldma_priv(lchan->vchan.chan.device); | 
 | 	struct ls2x_dma_sg *ldma_sg; | 
 | 	struct virt_dma_desc *vdesc; | 
 | 	u64 val; | 
 |  | 
 | 	/* Get the next descriptor */ | 
 | 	vdesc = vchan_next_desc(&lchan->vchan); | 
 | 	if (!vdesc) { | 
 | 		lchan->desc = NULL; | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	list_del(&vdesc->node); | 
 | 	lchan->desc = to_ldma_desc(vdesc); | 
 | 	ldma_sg = &lchan->desc->sg[0]; | 
 |  | 
 | 	/* Start DMA */ | 
 | 	lo_hi_writeq(0, priv->regs + LDMA_ORDER_ERG); | 
 | 	val = (ldma_sg->llp & ~LDMA_CONFIG_MASK) | LDMA_64BIT_EN | LDMA_START; | 
 | 	lo_hi_writeq(val, priv->regs + LDMA_ORDER_ERG); | 
 | } | 
 |  | 
 | static size_t ls2x_dmac_detect_burst(struct ls2x_dma_chan *lchan) | 
 | { | 
 | 	u32 maxburst, buswidth; | 
 |  | 
 | 	/* Reject definitely invalid configurations */ | 
 | 	if ((lchan->sconfig.src_addr_width & LDMA_SLAVE_BUSWIDTHS) && | 
 | 	    (lchan->sconfig.dst_addr_width & LDMA_SLAVE_BUSWIDTHS)) | 
 | 		return 0; | 
 |  | 
 | 	if (lchan->sconfig.direction == DMA_MEM_TO_DEV) { | 
 | 		maxburst = lchan->sconfig.dst_maxburst; | 
 | 		buswidth = lchan->sconfig.dst_addr_width; | 
 | 	} else { | 
 | 		maxburst = lchan->sconfig.src_maxburst; | 
 | 		buswidth = lchan->sconfig.src_addr_width; | 
 | 	} | 
 |  | 
 | 	/* If maxburst is zero, fallback to LDMA_MAX_TRANS_LEN */ | 
 | 	return maxburst ? (maxburst * buswidth) >> 2 : LDMA_MAX_TRANS_LEN; | 
 | } | 
 |  | 
 | static void ls2x_dma_fill_desc(struct ls2x_dma_chan *lchan, u32 sg_index, | 
 | 			       struct ls2x_dma_desc *desc) | 
 | { | 
 | 	struct ls2x_dma_sg *ldma_sg = &desc->sg[sg_index]; | 
 | 	u32 num_segments, segment_size; | 
 |  | 
 | 	if (desc->direction == DMA_MEM_TO_DEV) { | 
 | 		ldma_sg->hw->cmd = LDMA_INT | LDMA_DATA_DIRECTION; | 
 | 		ldma_sg->hw->apb_addr = lchan->sconfig.dst_addr; | 
 | 	} else { | 
 | 		ldma_sg->hw->cmd = LDMA_INT; | 
 | 		ldma_sg->hw->apb_addr = lchan->sconfig.src_addr; | 
 | 	} | 
 |  | 
 | 	ldma_sg->hw->mem_addr = lower_32_bits(ldma_sg->phys); | 
 | 	ldma_sg->hw->high_mem_addr = upper_32_bits(ldma_sg->phys); | 
 |  | 
 | 	/* Split into multiple equally sized segments if necessary */ | 
 | 	num_segments = DIV_ROUND_UP((ldma_sg->len + 3) >> 2, desc->burst_size); | 
 | 	segment_size = DIV_ROUND_UP((ldma_sg->len + 3) >> 2, num_segments); | 
 |  | 
 | 	/* Word count register takes input in words */ | 
 | 	ldma_sg->hw->len = segment_size; | 
 | 	ldma_sg->hw->step_times = num_segments; | 
 | 	ldma_sg->hw->step_len = 0; | 
 |  | 
 | 	/* lets make a link list */ | 
 | 	if (sg_index) { | 
 | 		desc->sg[sg_index - 1].hw->ndesc_addr = ldma_sg->llp | LDMA_DESC_EN; | 
 | 		desc->sg[sg_index - 1].hw->high_ndesc_addr = upper_32_bits(ldma_sg->llp); | 
 | 	} | 
 | } | 
 |  | 
 | /*--  DMA Engine API  --------------------------------------------------*/ | 
 |  | 
 | /* | 
 |  * ls2x_dma_alloc_chan_resources - allocate resources for DMA channel | 
 |  * @chan: allocate descriptor resources for this channel | 
 |  * | 
 |  * return - the number of allocated descriptors | 
 |  */ | 
 | static int ls2x_dma_alloc_chan_resources(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 |  | 
 | 	/* Create a pool of consistent memory blocks for hardware descriptors */ | 
 | 	lchan->pool = dma_pool_create(dev_name(chan2dev(chan)), | 
 | 				      chan->device->dev, PAGE_SIZE, | 
 | 				      __alignof__(struct ls2x_dma_hw_desc), 0); | 
 | 	if (!lchan->pool) { | 
 | 		dev_err(chan2dev(chan), "No memory for descriptors\n"); | 
 | 		return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	return 1; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_free_chan_resources - free all channel resources | 
 |  * @chan: DMA channel | 
 |  */ | 
 | static void ls2x_dma_free_chan_resources(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 |  | 
 | 	vchan_free_chan_resources(to_virt_chan(chan)); | 
 | 	dma_pool_destroy(lchan->pool); | 
 | 	lchan->pool = NULL; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_prep_slave_sg - prepare descriptors for a DMA_SLAVE transaction | 
 |  * @chan: DMA channel | 
 |  * @sgl: scatterlist to transfer to/from | 
 |  * @sg_len: number of entries in @scatterlist | 
 |  * @direction: DMA direction | 
 |  * @flags: tx descriptor status flags | 
 |  * @context: transaction context (ignored) | 
 |  * | 
 |  * Return: Async transaction descriptor on success and NULL on failure | 
 |  */ | 
 | 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) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 | 	struct ls2x_dma_desc *desc; | 
 | 	struct scatterlist *sg; | 
 | 	size_t burst_size; | 
 | 	int i; | 
 |  | 
 | 	if (unlikely(!sg_len || !is_slave_direction(direction))) | 
 | 		return NULL; | 
 |  | 
 | 	burst_size = ls2x_dmac_detect_burst(lchan); | 
 | 	if (!burst_size) | 
 | 		return NULL; | 
 |  | 
 | 	desc = kzalloc(struct_size(desc, sg, sg_len), GFP_NOWAIT); | 
 | 	if (!desc) | 
 | 		return NULL; | 
 |  | 
 | 	desc->desc_num = sg_len; | 
 | 	desc->direction = direction; | 
 | 	desc->burst_size = burst_size; | 
 |  | 
 | 	for_each_sg(sgl, sg, sg_len, i) { | 
 | 		struct ls2x_dma_sg *ldma_sg = &desc->sg[i]; | 
 |  | 
 | 		/* Allocate DMA capable memory for hardware descriptor */ | 
 | 		ldma_sg->hw = dma_pool_alloc(lchan->pool, GFP_NOWAIT, &ldma_sg->llp); | 
 | 		if (!ldma_sg->hw) { | 
 | 			desc->desc_num = i; | 
 | 			ls2x_dma_desc_free(&desc->vdesc); | 
 | 			return NULL; | 
 | 		} | 
 |  | 
 | 		ldma_sg->phys = sg_dma_address(sg); | 
 | 		ldma_sg->len = sg_dma_len(sg); | 
 |  | 
 | 		ls2x_dma_fill_desc(lchan, i, desc); | 
 | 	} | 
 |  | 
 | 	/* Setting the last descriptor enable bit */ | 
 | 	desc->sg[sg_len - 1].hw->ndesc_addr &= ~LDMA_DESC_EN; | 
 | 	desc->status = DMA_IN_PROGRESS; | 
 |  | 
 | 	return vchan_tx_prep(&lchan->vchan, &desc->vdesc, flags); | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_prep_dma_cyclic - prepare the cyclic DMA transfer | 
 |  * @chan: the DMA channel to prepare | 
 |  * @buf_addr: physical DMA address where the buffer starts | 
 |  * @buf_len: total number of bytes for the entire buffer | 
 |  * @period_len: number of bytes for each period | 
 |  * @direction: transfer direction, to or from device | 
 |  * @flags: tx descriptor status flags | 
 |  * | 
 |  * Return: Async transaction descriptor on success and NULL on failure | 
 |  */ | 
 | 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) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 | 	struct ls2x_dma_desc *desc; | 
 | 	size_t burst_size; | 
 | 	u32 num_periods; | 
 | 	int i; | 
 |  | 
 | 	if (unlikely(!buf_len || !period_len)) | 
 | 		return NULL; | 
 |  | 
 | 	if (unlikely(!is_slave_direction(direction))) | 
 | 		return NULL; | 
 |  | 
 | 	burst_size = ls2x_dmac_detect_burst(lchan); | 
 | 	if (!burst_size) | 
 | 		return NULL; | 
 |  | 
 | 	num_periods = buf_len / period_len; | 
 | 	desc = kzalloc(struct_size(desc, sg, num_periods), GFP_NOWAIT); | 
 | 	if (!desc) | 
 | 		return NULL; | 
 |  | 
 | 	desc->desc_num = num_periods; | 
 | 	desc->direction = direction; | 
 | 	desc->burst_size = burst_size; | 
 |  | 
 | 	/* Build cyclic linked list */ | 
 | 	for (i = 0; i < num_periods; i++) { | 
 | 		struct ls2x_dma_sg *ldma_sg = &desc->sg[i]; | 
 |  | 
 | 		/* Allocate DMA capable memory for hardware descriptor */ | 
 | 		ldma_sg->hw = dma_pool_alloc(lchan->pool, GFP_NOWAIT, &ldma_sg->llp); | 
 | 		if (!ldma_sg->hw) { | 
 | 			desc->desc_num = i; | 
 | 			ls2x_dma_desc_free(&desc->vdesc); | 
 | 			return NULL; | 
 | 		} | 
 |  | 
 | 		ldma_sg->phys = buf_addr + period_len * i; | 
 | 		ldma_sg->len = period_len; | 
 |  | 
 | 		ls2x_dma_fill_desc(lchan, i, desc); | 
 | 	} | 
 |  | 
 | 	/* Lets make a cyclic list */ | 
 | 	desc->sg[num_periods - 1].hw->ndesc_addr = desc->sg[0].llp | LDMA_DESC_EN; | 
 | 	desc->sg[num_periods - 1].hw->high_ndesc_addr = upper_32_bits(desc->sg[0].llp); | 
 | 	desc->cyclic = true; | 
 | 	desc->status = DMA_IN_PROGRESS; | 
 |  | 
 | 	return vchan_tx_prep(&lchan->vchan, &desc->vdesc, flags); | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_slave_config - set slave configuration for channel | 
 |  * @chan: dma channel | 
 |  * @cfg: slave configuration | 
 |  * | 
 |  * Sets slave configuration for channel | 
 |  */ | 
 | static int ls2x_dma_slave_config(struct dma_chan *chan, | 
 | 				 struct dma_slave_config *config) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 |  | 
 | 	memcpy(&lchan->sconfig, config, sizeof(*config)); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_issue_pending - push pending transactions to the hardware | 
 |  * @chan: channel | 
 |  * | 
 |  * When this function is called, all pending transactions are pushed to the | 
 |  * hardware and executed. | 
 |  */ | 
 | static void ls2x_dma_issue_pending(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&lchan->vchan.lock, flags); | 
 | 	if (vchan_issue_pending(&lchan->vchan) && !lchan->desc) | 
 | 		ls2x_dma_start_transfer(lchan); | 
 | 	spin_unlock_irqrestore(&lchan->vchan.lock, flags); | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_terminate_all - terminate all transactions | 
 |  * @chan: channel | 
 |  * | 
 |  * Stops all DMA transactions. | 
 |  */ | 
 | static int ls2x_dma_terminate_all(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 | 	unsigned long flags; | 
 | 	LIST_HEAD(head); | 
 |  | 
 | 	spin_lock_irqsave(&lchan->vchan.lock, flags); | 
 | 	/* Setting stop cmd */ | 
 | 	ls2x_dma_write_cmd(lchan, LDMA_STOP); | 
 | 	if (lchan->desc) { | 
 | 		vchan_terminate_vdesc(&lchan->desc->vdesc); | 
 | 		lchan->desc = NULL; | 
 | 	} | 
 |  | 
 | 	vchan_get_all_descriptors(&lchan->vchan, &head); | 
 | 	spin_unlock_irqrestore(&lchan->vchan.lock, flags); | 
 |  | 
 | 	vchan_dma_desc_free_list(&lchan->vchan, &head); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_synchronize - Synchronizes the termination of transfers to the | 
 |  * current context. | 
 |  * @chan: channel | 
 |  */ | 
 | static void ls2x_dma_synchronize(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 |  | 
 | 	vchan_synchronize(&lchan->vchan); | 
 | } | 
 |  | 
 | static int ls2x_dma_pause(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&lchan->vchan.lock, flags); | 
 | 	if (lchan->desc && lchan->desc->status == DMA_IN_PROGRESS) { | 
 | 		ls2x_dma_write_cmd(lchan, LDMA_STOP); | 
 | 		lchan->desc->status = DMA_PAUSED; | 
 | 	} | 
 | 	spin_unlock_irqrestore(&lchan->vchan.lock, flags); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int ls2x_dma_resume(struct dma_chan *chan) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = to_ldma_chan(chan); | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&lchan->vchan.lock, flags); | 
 | 	if (lchan->desc && lchan->desc->status == DMA_PAUSED) { | 
 | 		lchan->desc->status = DMA_IN_PROGRESS; | 
 | 		ls2x_dma_write_cmd(lchan, LDMA_START); | 
 | 	} | 
 | 	spin_unlock_irqrestore(&lchan->vchan.lock, flags); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_isr - LS2X DMA Interrupt handler | 
 |  * @irq: IRQ number | 
 |  * @dev_id: Pointer to ls2x_dma_chan | 
 |  * | 
 |  * Return: IRQ_HANDLED/IRQ_NONE | 
 |  */ | 
 | static irqreturn_t ls2x_dma_isr(int irq, void *dev_id) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = dev_id; | 
 | 	struct ls2x_dma_desc *desc; | 
 |  | 
 | 	spin_lock(&lchan->vchan.lock); | 
 | 	desc = lchan->desc; | 
 | 	if (desc) { | 
 | 		if (desc->cyclic) { | 
 | 			vchan_cyclic_callback(&desc->vdesc); | 
 | 		} else { | 
 | 			desc->status = DMA_COMPLETE; | 
 | 			vchan_cookie_complete(&desc->vdesc); | 
 | 			ls2x_dma_start_transfer(lchan); | 
 | 		} | 
 |  | 
 | 		/* ls2x_dma_start_transfer() updates lchan->desc */ | 
 | 		if (!lchan->desc) | 
 | 			ls2x_dma_write_cmd(lchan, LDMA_STOP); | 
 | 	} | 
 | 	spin_unlock(&lchan->vchan.lock); | 
 |  | 
 | 	return IRQ_HANDLED; | 
 | } | 
 |  | 
 | static int ls2x_dma_chan_init(struct platform_device *pdev, | 
 | 			      struct ls2x_dma_priv *priv) | 
 | { | 
 | 	struct ls2x_dma_chan *lchan = &priv->lchan; | 
 | 	struct device *dev = &pdev->dev; | 
 | 	int ret; | 
 |  | 
 | 	lchan->irq = platform_get_irq(pdev, 0); | 
 | 	if (lchan->irq < 0) | 
 | 		return lchan->irq; | 
 |  | 
 | 	ret = devm_request_irq(dev, lchan->irq, ls2x_dma_isr, IRQF_TRIGGER_RISING, | 
 | 			       dev_name(&pdev->dev), lchan); | 
 | 	if (ret) | 
 | 		return ret; | 
 |  | 
 | 	/* Initialize channels related values */ | 
 | 	INIT_LIST_HEAD(&priv->ddev.channels); | 
 | 	lchan->vchan.desc_free = ls2x_dma_desc_free; | 
 | 	vchan_init(&lchan->vchan, &priv->ddev); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_probe - Driver probe function | 
 |  * @pdev: Pointer to the platform_device structure | 
 |  * | 
 |  * Return: '0' on success and failure value on error | 
 |  */ | 
 | static int ls2x_dma_probe(struct platform_device *pdev) | 
 | { | 
 | 	struct device *dev = &pdev->dev; | 
 | 	struct ls2x_dma_priv *priv; | 
 | 	struct dma_device *ddev; | 
 | 	int ret; | 
 |  | 
 | 	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | 
 | 	if (!priv) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	priv->regs = devm_platform_ioremap_resource(pdev, 0); | 
 | 	if (IS_ERR(priv->regs)) | 
 | 		return dev_err_probe(dev, PTR_ERR(priv->regs), | 
 | 				     "devm_platform_ioremap_resource failed.\n"); | 
 |  | 
 | 	priv->dma_clk = devm_clk_get(&pdev->dev, NULL); | 
 | 	if (IS_ERR(priv->dma_clk)) | 
 | 		return dev_err_probe(dev, PTR_ERR(priv->dma_clk), "devm_clk_get failed.\n"); | 
 |  | 
 | 	ret = clk_prepare_enable(priv->dma_clk); | 
 | 	if (ret) | 
 | 		return dev_err_probe(dev, ret, "clk_prepare_enable failed.\n"); | 
 |  | 
 | 	ret = ls2x_dma_chan_init(pdev, priv); | 
 | 	if (ret) | 
 | 		goto disable_clk; | 
 |  | 
 | 	ddev = &priv->ddev; | 
 | 	ddev->dev = dev; | 
 | 	dma_cap_zero(ddev->cap_mask); | 
 | 	dma_cap_set(DMA_SLAVE, ddev->cap_mask); | 
 | 	dma_cap_set(DMA_CYCLIC, ddev->cap_mask); | 
 |  | 
 | 	ddev->device_alloc_chan_resources = ls2x_dma_alloc_chan_resources; | 
 | 	ddev->device_free_chan_resources = ls2x_dma_free_chan_resources; | 
 | 	ddev->device_tx_status = dma_cookie_status; | 
 | 	ddev->device_issue_pending = ls2x_dma_issue_pending; | 
 | 	ddev->device_prep_slave_sg = ls2x_dma_prep_slave_sg; | 
 | 	ddev->device_prep_dma_cyclic = ls2x_dma_prep_dma_cyclic; | 
 | 	ddev->device_config = ls2x_dma_slave_config; | 
 | 	ddev->device_terminate_all = ls2x_dma_terminate_all; | 
 | 	ddev->device_synchronize = ls2x_dma_synchronize; | 
 | 	ddev->device_pause = ls2x_dma_pause; | 
 | 	ddev->device_resume = ls2x_dma_resume; | 
 |  | 
 | 	ddev->src_addr_widths = LDMA_SLAVE_BUSWIDTHS; | 
 | 	ddev->dst_addr_widths = LDMA_SLAVE_BUSWIDTHS; | 
 | 	ddev->directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV); | 
 |  | 
 | 	ret = dma_async_device_register(&priv->ddev); | 
 | 	if (ret < 0) | 
 | 		goto disable_clk; | 
 |  | 
 | 	ret = of_dma_controller_register(dev->of_node, of_dma_xlate_by_chan_id, priv); | 
 | 	if (ret < 0) | 
 | 		goto unregister_dmac; | 
 |  | 
 | 	platform_set_drvdata(pdev, priv); | 
 |  | 
 | 	dev_info(dev, "Loongson LS2X APB DMA driver registered successfully.\n"); | 
 | 	return 0; | 
 |  | 
 | unregister_dmac: | 
 | 	dma_async_device_unregister(&priv->ddev); | 
 | disable_clk: | 
 | 	clk_disable_unprepare(priv->dma_clk); | 
 |  | 
 | 	return ret; | 
 | } | 
 |  | 
 | /* | 
 |  * ls2x_dma_remove - Driver remove function | 
 |  * @pdev: Pointer to the platform_device structure | 
 |  */ | 
 | static void ls2x_dma_remove(struct platform_device *pdev) | 
 | { | 
 | 	struct ls2x_dma_priv *priv = platform_get_drvdata(pdev); | 
 |  | 
 | 	of_dma_controller_free(pdev->dev.of_node); | 
 | 	dma_async_device_unregister(&priv->ddev); | 
 | 	clk_disable_unprepare(priv->dma_clk); | 
 | } | 
 |  | 
 | static const struct of_device_id ls2x_dma_of_match_table[] = { | 
 | 	{ .compatible = "loongson,ls2k1000-apbdma" }, | 
 | 	{ /* sentinel */ } | 
 | }; | 
 | MODULE_DEVICE_TABLE(of, ls2x_dma_of_match_table); | 
 |  | 
 | static struct platform_driver ls2x_dmac_driver = { | 
 | 	.probe		= ls2x_dma_probe, | 
 | 	.remove_new	= ls2x_dma_remove, | 
 | 	.driver = { | 
 | 		.name	= "ls2x-apbdma", | 
 | 		.of_match_table	= ls2x_dma_of_match_table, | 
 | 	}, | 
 | }; | 
 | module_platform_driver(ls2x_dmac_driver); | 
 |  | 
 | MODULE_DESCRIPTION("Loongson LS2X APB DMA Controller driver"); | 
 | MODULE_AUTHOR("Loongson Technology Corporation Limited"); | 
 | MODULE_LICENSE("GPL"); |