1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
4 */
5/*
6 * QCOM BAM DMA engine driver
7 *
8 * QCOM BAM DMA blocks are distributed amongst a number of the on-chip
9 * peripherals on the MSM 8x74.  The configuration of the channels are dependent
10 * on the way they are hard wired to that specific peripheral.  The peripheral
11 * device tree entries specify the configuration of each channel.
12 *
13 * The DMA controller requires the use of external memory for storage of the
14 * hardware descriptors for each channel.  The descriptor FIFO is accessed as a
15 * circular buffer and operations are managed according to the offset within the
16 * FIFO.  After pipe/channel reset, all of the pipe registers and internal state
17 * are back to defaults.
18 *
19 * During DMA operations, we write descriptors to the FIFO, being careful to
20 * handle wrapping and then write the last FIFO offset to that channel's
21 * P_EVNT_REG register to kick off the transaction.  The P_SW_OFSTS register
22 * indicates the current FIFO offset that is being processed, so there is some
23 * indication of where the hardware is currently working.
24 */
25
26#include <linux/kernel.h>
27#include <linux/io.h>
28#include <linux/init.h>
29#include <linux/slab.h>
30#include <linux/module.h>
31#include <linux/interrupt.h>
32#include <linux/dma-mapping.h>
33#include <linux/scatterlist.h>
34#include <linux/device.h>
35#include <linux/platform_device.h>
36#include <linux/of.h>
37#include <linux/of_address.h>
38#include <linux/of_irq.h>
39#include <linux/of_dma.h>
40#include <linux/circ_buf.h>
41#include <linux/clk.h>
42#include <linux/dmaengine.h>
43#include <linux/pm_runtime.h>
44
45#include "../dmaengine.h"
46#include "../virt-dma.h"
47
48struct bam_desc_hw {
49	__le32 addr;		/* Buffer physical address */
50	__le16 size;		/* Buffer size in bytes */
51	__le16 flags;
52};
53
54#define BAM_DMA_AUTOSUSPEND_DELAY 100
55
56#define DESC_FLAG_INT BIT(15)
57#define DESC_FLAG_EOT BIT(14)
58#define DESC_FLAG_EOB BIT(13)
59#define DESC_FLAG_NWD BIT(12)
60#define DESC_FLAG_CMD BIT(11)
61
62struct bam_async_desc {
63	struct virt_dma_desc vd;
64
65	u32 num_desc;
66	u32 xfer_len;
67
68	/* transaction flags, EOT|EOB|NWD */
69	u16 flags;
70
71	struct bam_desc_hw *curr_desc;
72
73	/* list node for the desc in the bam_chan list of descriptors */
74	struct list_head desc_node;
75	enum dma_transfer_direction dir;
76	size_t length;
77	struct bam_desc_hw desc[] __counted_by(num_desc);
78};
79
80enum bam_reg {
81	BAM_CTRL,
82	BAM_REVISION,
83	BAM_NUM_PIPES,
84	BAM_DESC_CNT_TRSHLD,
85	BAM_IRQ_SRCS,
86	BAM_IRQ_SRCS_MSK,
87	BAM_IRQ_SRCS_UNMASKED,
88	BAM_IRQ_STTS,
89	BAM_IRQ_CLR,
90	BAM_IRQ_EN,
91	BAM_CNFG_BITS,
92	BAM_IRQ_SRCS_EE,
93	BAM_IRQ_SRCS_MSK_EE,
94	BAM_P_CTRL,
95	BAM_P_RST,
96	BAM_P_HALT,
97	BAM_P_IRQ_STTS,
98	BAM_P_IRQ_CLR,
99	BAM_P_IRQ_EN,
100	BAM_P_EVNT_DEST_ADDR,
101	BAM_P_EVNT_REG,
102	BAM_P_SW_OFSTS,
103	BAM_P_DATA_FIFO_ADDR,
104	BAM_P_DESC_FIFO_ADDR,
105	BAM_P_EVNT_GEN_TRSHLD,
106	BAM_P_FIFO_SIZES,
107};
108
109struct reg_offset_data {
110	u32 base_offset;
111	unsigned int pipe_mult, evnt_mult, ee_mult;
112};
113
114static const struct reg_offset_data bam_v1_3_reg_info[] = {
115	[BAM_CTRL]		= { 0x0F80, 0x00, 0x00, 0x00 },
116	[BAM_REVISION]		= { 0x0F84, 0x00, 0x00, 0x00 },
117	[BAM_NUM_PIPES]		= { 0x0FBC, 0x00, 0x00, 0x00 },
118	[BAM_DESC_CNT_TRSHLD]	= { 0x0F88, 0x00, 0x00, 0x00 },
119	[BAM_IRQ_SRCS]		= { 0x0F8C, 0x00, 0x00, 0x00 },
120	[BAM_IRQ_SRCS_MSK]	= { 0x0F90, 0x00, 0x00, 0x00 },
121	[BAM_IRQ_SRCS_UNMASKED]	= { 0x0FB0, 0x00, 0x00, 0x00 },
122	[BAM_IRQ_STTS]		= { 0x0F94, 0x00, 0x00, 0x00 },
123	[BAM_IRQ_CLR]		= { 0x0F98, 0x00, 0x00, 0x00 },
124	[BAM_IRQ_EN]		= { 0x0F9C, 0x00, 0x00, 0x00 },
125	[BAM_CNFG_BITS]		= { 0x0FFC, 0x00, 0x00, 0x00 },
126	[BAM_IRQ_SRCS_EE]	= { 0x1800, 0x00, 0x00, 0x80 },
127	[BAM_IRQ_SRCS_MSK_EE]	= { 0x1804, 0x00, 0x00, 0x80 },
128	[BAM_P_CTRL]		= { 0x0000, 0x80, 0x00, 0x00 },
129	[BAM_P_RST]		= { 0x0004, 0x80, 0x00, 0x00 },
130	[BAM_P_HALT]		= { 0x0008, 0x80, 0x00, 0x00 },
131	[BAM_P_IRQ_STTS]	= { 0x0010, 0x80, 0x00, 0x00 },
132	[BAM_P_IRQ_CLR]		= { 0x0014, 0x80, 0x00, 0x00 },
133	[BAM_P_IRQ_EN]		= { 0x0018, 0x80, 0x00, 0x00 },
134	[BAM_P_EVNT_DEST_ADDR]	= { 0x102C, 0x00, 0x40, 0x00 },
135	[BAM_P_EVNT_REG]	= { 0x1018, 0x00, 0x40, 0x00 },
136	[BAM_P_SW_OFSTS]	= { 0x1000, 0x00, 0x40, 0x00 },
137	[BAM_P_DATA_FIFO_ADDR]	= { 0x1024, 0x00, 0x40, 0x00 },
138	[BAM_P_DESC_FIFO_ADDR]	= { 0x101C, 0x00, 0x40, 0x00 },
139	[BAM_P_EVNT_GEN_TRSHLD]	= { 0x1028, 0x00, 0x40, 0x00 },
140	[BAM_P_FIFO_SIZES]	= { 0x1020, 0x00, 0x40, 0x00 },
141};
142
143static const struct reg_offset_data bam_v1_4_reg_info[] = {
144	[BAM_CTRL]		= { 0x0000, 0x00, 0x00, 0x00 },
145	[BAM_REVISION]		= { 0x0004, 0x00, 0x00, 0x00 },
146	[BAM_NUM_PIPES]		= { 0x003C, 0x00, 0x00, 0x00 },
147	[BAM_DESC_CNT_TRSHLD]	= { 0x0008, 0x00, 0x00, 0x00 },
148	[BAM_IRQ_SRCS]		= { 0x000C, 0x00, 0x00, 0x00 },
149	[BAM_IRQ_SRCS_MSK]	= { 0x0010, 0x00, 0x00, 0x00 },
150	[BAM_IRQ_SRCS_UNMASKED]	= { 0x0030, 0x00, 0x00, 0x00 },
151	[BAM_IRQ_STTS]		= { 0x0014, 0x00, 0x00, 0x00 },
152	[BAM_IRQ_CLR]		= { 0x0018, 0x00, 0x00, 0x00 },
153	[BAM_IRQ_EN]		= { 0x001C, 0x00, 0x00, 0x00 },
154	[BAM_CNFG_BITS]		= { 0x007C, 0x00, 0x00, 0x00 },
155	[BAM_IRQ_SRCS_EE]	= { 0x0800, 0x00, 0x00, 0x80 },
156	[BAM_IRQ_SRCS_MSK_EE]	= { 0x0804, 0x00, 0x00, 0x80 },
157	[BAM_P_CTRL]		= { 0x1000, 0x1000, 0x00, 0x00 },
158	[BAM_P_RST]		= { 0x1004, 0x1000, 0x00, 0x00 },
159	[BAM_P_HALT]		= { 0x1008, 0x1000, 0x00, 0x00 },
160	[BAM_P_IRQ_STTS]	= { 0x1010, 0x1000, 0x00, 0x00 },
161	[BAM_P_IRQ_CLR]		= { 0x1014, 0x1000, 0x00, 0x00 },
162	[BAM_P_IRQ_EN]		= { 0x1018, 0x1000, 0x00, 0x00 },
163	[BAM_P_EVNT_DEST_ADDR]	= { 0x182C, 0x00, 0x1000, 0x00 },
164	[BAM_P_EVNT_REG]	= { 0x1818, 0x00, 0x1000, 0x00 },
165	[BAM_P_SW_OFSTS]	= { 0x1800, 0x00, 0x1000, 0x00 },
166	[BAM_P_DATA_FIFO_ADDR]	= { 0x1824, 0x00, 0x1000, 0x00 },
167	[BAM_P_DESC_FIFO_ADDR]	= { 0x181C, 0x00, 0x1000, 0x00 },
168	[BAM_P_EVNT_GEN_TRSHLD]	= { 0x1828, 0x00, 0x1000, 0x00 },
169	[BAM_P_FIFO_SIZES]	= { 0x1820, 0x00, 0x1000, 0x00 },
170};
171
172static const struct reg_offset_data bam_v1_7_reg_info[] = {
173	[BAM_CTRL]		= { 0x00000, 0x00, 0x00, 0x00 },
174	[BAM_REVISION]		= { 0x01000, 0x00, 0x00, 0x00 },
175	[BAM_NUM_PIPES]		= { 0x01008, 0x00, 0x00, 0x00 },
176	[BAM_DESC_CNT_TRSHLD]	= { 0x00008, 0x00, 0x00, 0x00 },
177	[BAM_IRQ_SRCS]		= { 0x03010, 0x00, 0x00, 0x00 },
178	[BAM_IRQ_SRCS_MSK]	= { 0x03014, 0x00, 0x00, 0x00 },
179	[BAM_IRQ_SRCS_UNMASKED]	= { 0x03018, 0x00, 0x00, 0x00 },
180	[BAM_IRQ_STTS]		= { 0x00014, 0x00, 0x00, 0x00 },
181	[BAM_IRQ_CLR]		= { 0x00018, 0x00, 0x00, 0x00 },
182	[BAM_IRQ_EN]		= { 0x0001C, 0x00, 0x00, 0x00 },
183	[BAM_CNFG_BITS]		= { 0x0007C, 0x00, 0x00, 0x00 },
184	[BAM_IRQ_SRCS_EE]	= { 0x03000, 0x00, 0x00, 0x1000 },
185	[BAM_IRQ_SRCS_MSK_EE]	= { 0x03004, 0x00, 0x00, 0x1000 },
186	[BAM_P_CTRL]		= { 0x13000, 0x1000, 0x00, 0x00 },
187	[BAM_P_RST]		= { 0x13004, 0x1000, 0x00, 0x00 },
188	[BAM_P_HALT]		= { 0x13008, 0x1000, 0x00, 0x00 },
189	[BAM_P_IRQ_STTS]	= { 0x13010, 0x1000, 0x00, 0x00 },
190	[BAM_P_IRQ_CLR]		= { 0x13014, 0x1000, 0x00, 0x00 },
191	[BAM_P_IRQ_EN]		= { 0x13018, 0x1000, 0x00, 0x00 },
192	[BAM_P_EVNT_DEST_ADDR]	= { 0x1382C, 0x00, 0x1000, 0x00 },
193	[BAM_P_EVNT_REG]	= { 0x13818, 0x00, 0x1000, 0x00 },
194	[BAM_P_SW_OFSTS]	= { 0x13800, 0x00, 0x1000, 0x00 },
195	[BAM_P_DATA_FIFO_ADDR]	= { 0x13824, 0x00, 0x1000, 0x00 },
196	[BAM_P_DESC_FIFO_ADDR]	= { 0x1381C, 0x00, 0x1000, 0x00 },
197	[BAM_P_EVNT_GEN_TRSHLD]	= { 0x13828, 0x00, 0x1000, 0x00 },
198	[BAM_P_FIFO_SIZES]	= { 0x13820, 0x00, 0x1000, 0x00 },
199};
200
201/* BAM CTRL */
202#define BAM_SW_RST			BIT(0)
203#define BAM_EN				BIT(1)
204#define BAM_EN_ACCUM			BIT(4)
205#define BAM_TESTBUS_SEL_SHIFT		5
206#define BAM_TESTBUS_SEL_MASK		0x3F
207#define BAM_DESC_CACHE_SEL_SHIFT	13
208#define BAM_DESC_CACHE_SEL_MASK		0x3
209#define BAM_CACHED_DESC_STORE		BIT(15)
210#define IBC_DISABLE			BIT(16)
211
212/* BAM REVISION */
213#define REVISION_SHIFT		0
214#define REVISION_MASK		0xFF
215#define NUM_EES_SHIFT		8
216#define NUM_EES_MASK		0xF
217#define CE_BUFFER_SIZE		BIT(13)
218#define AXI_ACTIVE		BIT(14)
219#define USE_VMIDMT		BIT(15)
220#define SECURED			BIT(16)
221#define BAM_HAS_NO_BYPASS	BIT(17)
222#define HIGH_FREQUENCY_BAM	BIT(18)
223#define INACTIV_TMRS_EXST	BIT(19)
224#define NUM_INACTIV_TMRS	BIT(20)
225#define DESC_CACHE_DEPTH_SHIFT	21
226#define DESC_CACHE_DEPTH_1	(0 << DESC_CACHE_DEPTH_SHIFT)
227#define DESC_CACHE_DEPTH_2	(1 << DESC_CACHE_DEPTH_SHIFT)
228#define DESC_CACHE_DEPTH_3	(2 << DESC_CACHE_DEPTH_SHIFT)
229#define DESC_CACHE_DEPTH_4	(3 << DESC_CACHE_DEPTH_SHIFT)
230#define CMD_DESC_EN		BIT(23)
231#define INACTIV_TMR_BASE_SHIFT	24
232#define INACTIV_TMR_BASE_MASK	0xFF
233
234/* BAM NUM PIPES */
235#define BAM_NUM_PIPES_SHIFT		0
236#define BAM_NUM_PIPES_MASK		0xFF
237#define PERIPH_NON_PIPE_GRP_SHIFT	16
238#define PERIPH_NON_PIP_GRP_MASK		0xFF
239#define BAM_NON_PIPE_GRP_SHIFT		24
240#define BAM_NON_PIPE_GRP_MASK		0xFF
241
242/* BAM CNFG BITS */
243#define BAM_PIPE_CNFG		BIT(2)
244#define BAM_FULL_PIPE		BIT(11)
245#define BAM_NO_EXT_P_RST	BIT(12)
246#define BAM_IBC_DISABLE		BIT(13)
247#define BAM_SB_CLK_REQ		BIT(14)
248#define BAM_PSM_CSW_REQ		BIT(15)
249#define BAM_PSM_P_RES		BIT(16)
250#define BAM_AU_P_RES		BIT(17)
251#define BAM_SI_P_RES		BIT(18)
252#define BAM_WB_P_RES		BIT(19)
253#define BAM_WB_BLK_CSW		BIT(20)
254#define BAM_WB_CSW_ACK_IDL	BIT(21)
255#define BAM_WB_RETR_SVPNT	BIT(22)
256#define BAM_WB_DSC_AVL_P_RST	BIT(23)
257#define BAM_REG_P_EN		BIT(24)
258#define BAM_PSM_P_HD_DATA	BIT(25)
259#define BAM_AU_ACCUMED		BIT(26)
260#define BAM_CMD_ENABLE		BIT(27)
261
262#define BAM_CNFG_BITS_DEFAULT	(BAM_PIPE_CNFG |	\
263				 BAM_NO_EXT_P_RST |	\
264				 BAM_IBC_DISABLE |	\
265				 BAM_SB_CLK_REQ |	\
266				 BAM_PSM_CSW_REQ |	\
267				 BAM_PSM_P_RES |	\
268				 BAM_AU_P_RES |		\
269				 BAM_SI_P_RES |		\
270				 BAM_WB_P_RES |		\
271				 BAM_WB_BLK_CSW |	\
272				 BAM_WB_CSW_ACK_IDL |	\
273				 BAM_WB_RETR_SVPNT |	\
274				 BAM_WB_DSC_AVL_P_RST |	\
275				 BAM_REG_P_EN |		\
276				 BAM_PSM_P_HD_DATA |	\
277				 BAM_AU_ACCUMED |	\
278				 BAM_CMD_ENABLE)
279
280/* PIPE CTRL */
281#define P_EN			BIT(1)
282#define P_DIRECTION		BIT(3)
283#define P_SYS_STRM		BIT(4)
284#define P_SYS_MODE		BIT(5)
285#define P_AUTO_EOB		BIT(6)
286#define P_AUTO_EOB_SEL_SHIFT	7
287#define P_AUTO_EOB_SEL_512	(0 << P_AUTO_EOB_SEL_SHIFT)
288#define P_AUTO_EOB_SEL_256	(1 << P_AUTO_EOB_SEL_SHIFT)
289#define P_AUTO_EOB_SEL_128	(2 << P_AUTO_EOB_SEL_SHIFT)
290#define P_AUTO_EOB_SEL_64	(3 << P_AUTO_EOB_SEL_SHIFT)
291#define P_PREFETCH_LIMIT_SHIFT	9
292#define P_PREFETCH_LIMIT_32	(0 << P_PREFETCH_LIMIT_SHIFT)
293#define P_PREFETCH_LIMIT_16	(1 << P_PREFETCH_LIMIT_SHIFT)
294#define P_PREFETCH_LIMIT_4	(2 << P_PREFETCH_LIMIT_SHIFT)
295#define P_WRITE_NWD		BIT(11)
296#define P_LOCK_GROUP_SHIFT	16
297#define P_LOCK_GROUP_MASK	0x1F
298
299/* BAM_DESC_CNT_TRSHLD */
300#define CNT_TRSHLD		0xffff
301#define DEFAULT_CNT_THRSHLD	0x4
302
303/* BAM_IRQ_SRCS */
304#define BAM_IRQ			BIT(31)
305#define P_IRQ			0x7fffffff
306
307/* BAM_IRQ_SRCS_MSK */
308#define BAM_IRQ_MSK		BAM_IRQ
309#define P_IRQ_MSK		P_IRQ
310
311/* BAM_IRQ_STTS */
312#define BAM_TIMER_IRQ		BIT(4)
313#define BAM_EMPTY_IRQ		BIT(3)
314#define BAM_ERROR_IRQ		BIT(2)
315#define BAM_HRESP_ERR_IRQ	BIT(1)
316
317/* BAM_IRQ_CLR */
318#define BAM_TIMER_CLR		BIT(4)
319#define BAM_EMPTY_CLR		BIT(3)
320#define BAM_ERROR_CLR		BIT(2)
321#define BAM_HRESP_ERR_CLR	BIT(1)
322
323/* BAM_IRQ_EN */
324#define BAM_TIMER_EN		BIT(4)
325#define BAM_EMPTY_EN		BIT(3)
326#define BAM_ERROR_EN		BIT(2)
327#define BAM_HRESP_ERR_EN	BIT(1)
328
329/* BAM_P_IRQ_EN */
330#define P_PRCSD_DESC_EN		BIT(0)
331#define P_TIMER_EN		BIT(1)
332#define P_WAKE_EN		BIT(2)
333#define P_OUT_OF_DESC_EN	BIT(3)
334#define P_ERR_EN		BIT(4)
335#define P_TRNSFR_END_EN		BIT(5)
336#define P_DEFAULT_IRQS_EN	(P_PRCSD_DESC_EN | P_ERR_EN | P_TRNSFR_END_EN)
337
338/* BAM_P_SW_OFSTS */
339#define P_SW_OFSTS_MASK		0xffff
340
341#define BAM_DESC_FIFO_SIZE	SZ_32K
342#define MAX_DESCRIPTORS (BAM_DESC_FIFO_SIZE / sizeof(struct bam_desc_hw) - 1)
343#define BAM_FIFO_SIZE	(SZ_32K - 8)
344#define IS_BUSY(chan)	(CIRC_SPACE(bchan->tail, bchan->head,\
345			 MAX_DESCRIPTORS + 1) == 0)
346
347struct bam_chan {
348	struct virt_dma_chan vc;
349
350	struct bam_device *bdev;
351
352	/* configuration from device tree */
353	u32 id;
354
355	/* runtime configuration */
356	struct dma_slave_config slave;
357
358	/* fifo storage */
359	struct bam_desc_hw *fifo_virt;
360	dma_addr_t fifo_phys;
361
362	/* fifo markers */
363	unsigned short head;		/* start of active descriptor entries */
364	unsigned short tail;		/* end of active descriptor entries */
365
366	unsigned int initialized;	/* is the channel hw initialized? */
367	unsigned int paused;		/* is the channel paused? */
368	unsigned int reconfigure;	/* new slave config? */
369	/* list of descriptors currently processed */
370	struct list_head desc_list;
371
372	struct list_head node;
373};
374
375static inline struct bam_chan *to_bam_chan(struct dma_chan *common)
376{
377	return container_of(common, struct bam_chan, vc.chan);
378}
379
380struct bam_device {
381	void __iomem *regs;
382	struct device *dev;
383	struct dma_device common;
384	struct bam_chan *channels;
385	u32 num_channels;
386	u32 num_ees;
387
388	/* execution environment ID, from DT */
389	u32 ee;
390	bool controlled_remotely;
391	bool powered_remotely;
392	u32 active_channels;
393
394	const struct reg_offset_data *layout;
395
396	struct clk *bamclk;
397	int irq;
398
399	/* dma start transaction tasklet */
400	struct tasklet_struct task;
401};
402
403/**
404 * bam_addr - returns BAM register address
405 * @bdev: bam device
406 * @pipe: pipe instance (ignored when register doesn't have multiple instances)
407 * @reg:  register enum
408 */
409static inline void __iomem *bam_addr(struct bam_device *bdev, u32 pipe,
410		enum bam_reg reg)
411{
412	const struct reg_offset_data r = bdev->layout[reg];
413
414	return bdev->regs + r.base_offset +
415		r.pipe_mult * pipe +
416		r.evnt_mult * pipe +
417		r.ee_mult * bdev->ee;
418}
419
420/**
421 * bam_reset() - reset and initialize BAM registers
422 * @bdev: bam device
423 */
424static void bam_reset(struct bam_device *bdev)
425{
426	u32 val;
427
428	/* s/w reset bam */
429	/* after reset all pipes are disabled and idle */
430	val = readl_relaxed(bam_addr(bdev, 0, BAM_CTRL));
431	val |= BAM_SW_RST;
432	writel_relaxed(val, bam_addr(bdev, 0, BAM_CTRL));
433	val &= ~BAM_SW_RST;
434	writel_relaxed(val, bam_addr(bdev, 0, BAM_CTRL));
435
436	/* make sure previous stores are visible before enabling BAM */
437	wmb();
438
439	/* enable bam */
440	val |= BAM_EN;
441	writel_relaxed(val, bam_addr(bdev, 0, BAM_CTRL));
442
443	/* set descriptor threshhold, start with 4 bytes */
444	writel_relaxed(DEFAULT_CNT_THRSHLD,
445			bam_addr(bdev, 0, BAM_DESC_CNT_TRSHLD));
446
447	/* Enable default set of h/w workarounds, ie all except BAM_FULL_PIPE */
448	writel_relaxed(BAM_CNFG_BITS_DEFAULT, bam_addr(bdev, 0, BAM_CNFG_BITS));
449
450	/* enable irqs for errors */
451	writel_relaxed(BAM_ERROR_EN | BAM_HRESP_ERR_EN,
452			bam_addr(bdev, 0, BAM_IRQ_EN));
453
454	/* unmask global bam interrupt */
455	writel_relaxed(BAM_IRQ_MSK, bam_addr(bdev, 0, BAM_IRQ_SRCS_MSK_EE));
456}
457
458/**
459 * bam_reset_channel - Reset individual BAM DMA channel
460 * @bchan: bam channel
461 *
462 * This function resets a specific BAM channel
463 */
464static void bam_reset_channel(struct bam_chan *bchan)
465{
466	struct bam_device *bdev = bchan->bdev;
467
468	lockdep_assert_held(&bchan->vc.lock);
469
470	/* reset channel */
471	writel_relaxed(1, bam_addr(bdev, bchan->id, BAM_P_RST));
472	writel_relaxed(0, bam_addr(bdev, bchan->id, BAM_P_RST));
473
474	/* don't allow cpu to reorder BAM register accesses done after this */
475	wmb();
476
477	/* make sure hw is initialized when channel is used the first time  */
478	bchan->initialized = 0;
479}
480
481/**
482 * bam_chan_init_hw - Initialize channel hardware
483 * @bchan: bam channel
484 * @dir: DMA transfer direction
485 *
486 * This function resets and initializes the BAM channel
487 */
488static void bam_chan_init_hw(struct bam_chan *bchan,
489	enum dma_transfer_direction dir)
490{
491	struct bam_device *bdev = bchan->bdev;
492	u32 val;
493
494	/* Reset the channel to clear internal state of the FIFO */
495	bam_reset_channel(bchan);
496
497	/*
498	 * write out 8 byte aligned address.  We have enough space for this
499	 * because we allocated 1 more descriptor (8 bytes) than we can use
500	 */
501	writel_relaxed(ALIGN(bchan->fifo_phys, sizeof(struct bam_desc_hw)),
502			bam_addr(bdev, bchan->id, BAM_P_DESC_FIFO_ADDR));
503	writel_relaxed(BAM_FIFO_SIZE,
504			bam_addr(bdev, bchan->id, BAM_P_FIFO_SIZES));
505
506	/* enable the per pipe interrupts, enable EOT, ERR, and INT irqs */
507	writel_relaxed(P_DEFAULT_IRQS_EN,
508			bam_addr(bdev, bchan->id, BAM_P_IRQ_EN));
509
510	/* unmask the specific pipe and EE combo */
511	val = readl_relaxed(bam_addr(bdev, 0, BAM_IRQ_SRCS_MSK_EE));
512	val |= BIT(bchan->id);
513	writel_relaxed(val, bam_addr(bdev, 0, BAM_IRQ_SRCS_MSK_EE));
514
515	/* don't allow cpu to reorder the channel enable done below */
516	wmb();
517
518	/* set fixed direction and mode, then enable channel */
519	val = P_EN | P_SYS_MODE;
520	if (dir == DMA_DEV_TO_MEM)
521		val |= P_DIRECTION;
522
523	writel_relaxed(val, bam_addr(bdev, bchan->id, BAM_P_CTRL));
524
525	bchan->initialized = 1;
526
527	/* init FIFO pointers */
528	bchan->head = 0;
529	bchan->tail = 0;
530}
531
532/**
533 * bam_alloc_chan - Allocate channel resources for DMA channel.
534 * @chan: specified channel
535 *
536 * This function allocates the FIFO descriptor memory
537 */
538static int bam_alloc_chan(struct dma_chan *chan)
539{
540	struct bam_chan *bchan = to_bam_chan(chan);
541	struct bam_device *bdev = bchan->bdev;
542
543	if (bchan->fifo_virt)
544		return 0;
545
546	/* allocate FIFO descriptor space, but only if necessary */
547	bchan->fifo_virt = dma_alloc_wc(bdev->dev, BAM_DESC_FIFO_SIZE,
548					&bchan->fifo_phys, GFP_KERNEL);
549
550	if (!bchan->fifo_virt) {
551		dev_err(bdev->dev, "Failed to allocate desc fifo\n");
552		return -ENOMEM;
553	}
554
555	if (bdev->active_channels++ == 0 && bdev->powered_remotely)
556		bam_reset(bdev);
557
558	return 0;
559}
560
561/**
562 * bam_free_chan - Frees dma resources associated with specific channel
563 * @chan: specified channel
564 *
565 * Free the allocated fifo descriptor memory and channel resources
566 *
567 */
568static void bam_free_chan(struct dma_chan *chan)
569{
570	struct bam_chan *bchan = to_bam_chan(chan);
571	struct bam_device *bdev = bchan->bdev;
572	u32 val;
573	unsigned long flags;
574	int ret;
575
576	ret = pm_runtime_get_sync(bdev->dev);
577	if (ret < 0)
578		return;
579
580	vchan_free_chan_resources(to_virt_chan(chan));
581
582	if (!list_empty(&bchan->desc_list)) {
583		dev_err(bchan->bdev->dev, "Cannot free busy channel\n");
584		goto err;
585	}
586
587	spin_lock_irqsave(&bchan->vc.lock, flags);
588	bam_reset_channel(bchan);
589	spin_unlock_irqrestore(&bchan->vc.lock, flags);
590
591	dma_free_wc(bdev->dev, BAM_DESC_FIFO_SIZE, bchan->fifo_virt,
592		    bchan->fifo_phys);
593	bchan->fifo_virt = NULL;
594
595	/* mask irq for pipe/channel */
596	val = readl_relaxed(bam_addr(bdev, 0, BAM_IRQ_SRCS_MSK_EE));
597	val &= ~BIT(bchan->id);
598	writel_relaxed(val, bam_addr(bdev, 0, BAM_IRQ_SRCS_MSK_EE));
599
600	/* disable irq */
601	writel_relaxed(0, bam_addr(bdev, bchan->id, BAM_P_IRQ_EN));
602
603	if (--bdev->active_channels == 0 && bdev->powered_remotely) {
604		/* s/w reset bam */
605		val = readl_relaxed(bam_addr(bdev, 0, BAM_CTRL));
606		val |= BAM_SW_RST;
607		writel_relaxed(val, bam_addr(bdev, 0, BAM_CTRL));
608	}
609
610err:
611	pm_runtime_mark_last_busy(bdev->dev);
612	pm_runtime_put_autosuspend(bdev->dev);
613}
614
615/**
616 * bam_slave_config - set slave configuration for channel
617 * @chan: dma channel
618 * @cfg: slave configuration
619 *
620 * Sets slave configuration for channel
621 *
622 */
623static int bam_slave_config(struct dma_chan *chan,
624			    struct dma_slave_config *cfg)
625{
626	struct bam_chan *bchan = to_bam_chan(chan);
627	unsigned long flag;
628
629	spin_lock_irqsave(&bchan->vc.lock, flag);
630	memcpy(&bchan->slave, cfg, sizeof(*cfg));
631	bchan->reconfigure = 1;
632	spin_unlock_irqrestore(&bchan->vc.lock, flag);
633
634	return 0;
635}
636
637/**
638 * bam_prep_slave_sg - Prep slave sg transaction
639 *
640 * @chan: dma channel
641 * @sgl: scatter gather list
642 * @sg_len: length of sg
643 * @direction: DMA transfer direction
644 * @flags: DMA flags
645 * @context: transfer context (unused)
646 */
647static struct dma_async_tx_descriptor *bam_prep_slave_sg(struct dma_chan *chan,
648	struct scatterlist *sgl, unsigned int sg_len,
649	enum dma_transfer_direction direction, unsigned long flags,
650	void *context)
651{
652	struct bam_chan *bchan = to_bam_chan(chan);
653	struct bam_device *bdev = bchan->bdev;
654	struct bam_async_desc *async_desc;
655	struct scatterlist *sg;
656	u32 i;
657	struct bam_desc_hw *desc;
658	unsigned int num_alloc = 0;
659
660
661	if (!is_slave_direction(direction)) {
662		dev_err(bdev->dev, "invalid dma direction\n");
663		return NULL;
664	}
665
666	/* calculate number of required entries */
667	for_each_sg(sgl, sg, sg_len, i)
668		num_alloc += DIV_ROUND_UP(sg_dma_len(sg), BAM_FIFO_SIZE);
669
670	/* allocate enough room to accomodate the number of entries */
671	async_desc = kzalloc(struct_size(async_desc, desc, num_alloc),
672			     GFP_NOWAIT);
673
674	if (!async_desc)
675		return NULL;
676
677	if (flags & DMA_PREP_FENCE)
678		async_desc->flags |= DESC_FLAG_NWD;
679
680	if (flags & DMA_PREP_INTERRUPT)
681		async_desc->flags |= DESC_FLAG_EOT;
682
683	async_desc->num_desc = num_alloc;
684	async_desc->curr_desc = async_desc->desc;
685	async_desc->dir = direction;
686
687	/* fill in temporary descriptors */
688	desc = async_desc->desc;
689	for_each_sg(sgl, sg, sg_len, i) {
690		unsigned int remainder = sg_dma_len(sg);
691		unsigned int curr_offset = 0;
692
693		do {
694			if (flags & DMA_PREP_CMD)
695				desc->flags |= cpu_to_le16(DESC_FLAG_CMD);
696
697			desc->addr = cpu_to_le32(sg_dma_address(sg) +
698						 curr_offset);
699
700			if (remainder > BAM_FIFO_SIZE) {
701				desc->size = cpu_to_le16(BAM_FIFO_SIZE);
702				remainder -= BAM_FIFO_SIZE;
703				curr_offset += BAM_FIFO_SIZE;
704			} else {
705				desc->size = cpu_to_le16(remainder);
706				remainder = 0;
707			}
708
709			async_desc->length += le16_to_cpu(desc->size);
710			desc++;
711		} while (remainder > 0);
712	}
713
714	return vchan_tx_prep(&bchan->vc, &async_desc->vd, flags);
715}
716
717/**
718 * bam_dma_terminate_all - terminate all transactions on a channel
719 * @chan: bam dma channel
720 *
721 * Dequeues and frees all transactions
722 * No callbacks are done
723 *
724 */
725static int bam_dma_terminate_all(struct dma_chan *chan)
726{
727	struct bam_chan *bchan = to_bam_chan(chan);
728	struct bam_async_desc *async_desc, *tmp;
729	unsigned long flag;
730	LIST_HEAD(head);
731
732	/* remove all transactions, including active transaction */
733	spin_lock_irqsave(&bchan->vc.lock, flag);
734	/*
735	 * If we have transactions queued, then some might be committed to the
736	 * hardware in the desc fifo.  The only way to reset the desc fifo is
737	 * to do a hardware reset (either by pipe or the entire block).
738	 * bam_chan_init_hw() will trigger a pipe reset, and also reinit the
739	 * pipe.  If the pipe is left disabled (default state after pipe reset)
740	 * and is accessed by a connected hardware engine, a fatal error in
741	 * the BAM will occur.  There is a small window where this could happen
742	 * with bam_chan_init_hw(), but it is assumed that the caller has
743	 * stopped activity on any attached hardware engine.  Make sure to do
744	 * this first so that the BAM hardware doesn't cause memory corruption
745	 * by accessing freed resources.
746	 */
747	if (!list_empty(&bchan->desc_list)) {
748		async_desc = list_first_entry(&bchan->desc_list,
749					      struct bam_async_desc, desc_node);
750		bam_chan_init_hw(bchan, async_desc->dir);
751	}
752
753	list_for_each_entry_safe(async_desc, tmp,
754				 &bchan->desc_list, desc_node) {
755		list_add(&async_desc->vd.node, &bchan->vc.desc_issued);
756		list_del(&async_desc->desc_node);
757	}
758
759	vchan_get_all_descriptors(&bchan->vc, &head);
760	spin_unlock_irqrestore(&bchan->vc.lock, flag);
761
762	vchan_dma_desc_free_list(&bchan->vc, &head);
763
764	return 0;
765}
766
767/**
768 * bam_pause - Pause DMA channel
769 * @chan: dma channel
770 *
771 */
772static int bam_pause(struct dma_chan *chan)
773{
774	struct bam_chan *bchan = to_bam_chan(chan);
775	struct bam_device *bdev = bchan->bdev;
776	unsigned long flag;
777	int ret;
778
779	ret = pm_runtime_get_sync(bdev->dev);
780	if (ret < 0)
781		return ret;
782
783	spin_lock_irqsave(&bchan->vc.lock, flag);
784	writel_relaxed(1, bam_addr(bdev, bchan->id, BAM_P_HALT));
785	bchan->paused = 1;
786	spin_unlock_irqrestore(&bchan->vc.lock, flag);
787	pm_runtime_mark_last_busy(bdev->dev);
788	pm_runtime_put_autosuspend(bdev->dev);
789
790	return 0;
791}
792
793/**
794 * bam_resume - Resume DMA channel operations
795 * @chan: dma channel
796 *
797 */
798static int bam_resume(struct dma_chan *chan)
799{
800	struct bam_chan *bchan = to_bam_chan(chan);
801	struct bam_device *bdev = bchan->bdev;
802	unsigned long flag;
803	int ret;
804
805	ret = pm_runtime_get_sync(bdev->dev);
806	if (ret < 0)
807		return ret;
808
809	spin_lock_irqsave(&bchan->vc.lock, flag);
810	writel_relaxed(0, bam_addr(bdev, bchan->id, BAM_P_HALT));
811	bchan->paused = 0;
812	spin_unlock_irqrestore(&bchan->vc.lock, flag);
813	pm_runtime_mark_last_busy(bdev->dev);
814	pm_runtime_put_autosuspend(bdev->dev);
815
816	return 0;
817}
818
819/**
820 * process_channel_irqs - processes the channel interrupts
821 * @bdev: bam controller
822 *
823 * This function processes the channel interrupts
824 *
825 */
826static u32 process_channel_irqs(struct bam_device *bdev)
827{
828	u32 i, srcs, pipe_stts, offset, avail;
829	unsigned long flags;
830	struct bam_async_desc *async_desc, *tmp;
831
832	srcs = readl_relaxed(bam_addr(bdev, 0, BAM_IRQ_SRCS_EE));
833
834	/* return early if no pipe/channel interrupts are present */
835	if (!(srcs & P_IRQ))
836		return srcs;
837
838	for (i = 0; i < bdev->num_channels; i++) {
839		struct bam_chan *bchan = &bdev->channels[i];
840
841		if (!(srcs & BIT(i)))
842			continue;
843
844		/* clear pipe irq */
845		pipe_stts = readl_relaxed(bam_addr(bdev, i, BAM_P_IRQ_STTS));
846
847		writel_relaxed(pipe_stts, bam_addr(bdev, i, BAM_P_IRQ_CLR));
848
849		spin_lock_irqsave(&bchan->vc.lock, flags);
850
851		offset = readl_relaxed(bam_addr(bdev, i, BAM_P_SW_OFSTS)) &
852				       P_SW_OFSTS_MASK;
853		offset /= sizeof(struct bam_desc_hw);
854
855		/* Number of bytes available to read */
856		avail = CIRC_CNT(offset, bchan->head, MAX_DESCRIPTORS + 1);
857
858		if (offset < bchan->head)
859			avail--;
860
861		list_for_each_entry_safe(async_desc, tmp,
862					 &bchan->desc_list, desc_node) {
863			/* Not enough data to read */
864			if (avail < async_desc->xfer_len)
865				break;
866
867			/* manage FIFO */
868			bchan->head += async_desc->xfer_len;
869			bchan->head %= MAX_DESCRIPTORS;
870
871			async_desc->num_desc -= async_desc->xfer_len;
872			async_desc->curr_desc += async_desc->xfer_len;
873			avail -= async_desc->xfer_len;
874
875			/*
876			 * if complete, process cookie. Otherwise
877			 * push back to front of desc_issued so that
878			 * it gets restarted by the tasklet
879			 */
880			if (!async_desc->num_desc) {
881				vchan_cookie_complete(&async_desc->vd);
882			} else {
883				list_add(&async_desc->vd.node,
884					 &bchan->vc.desc_issued);
885			}
886			list_del(&async_desc->desc_node);
887		}
888
889		spin_unlock_irqrestore(&bchan->vc.lock, flags);
890	}
891
892	return srcs;
893}
894
895/**
896 * bam_dma_irq - irq handler for bam controller
897 * @irq: IRQ of interrupt
898 * @data: callback data
899 *
900 * IRQ handler for the bam controller
901 */
902static irqreturn_t bam_dma_irq(int irq, void *data)
903{
904	struct bam_device *bdev = data;
905	u32 clr_mask = 0, srcs = 0;
906	int ret;
907
908	srcs |= process_channel_irqs(bdev);
909
910	/* kick off tasklet to start next dma transfer */
911	if (srcs & P_IRQ)
912		tasklet_schedule(&bdev->task);
913
914	ret = pm_runtime_get_sync(bdev->dev);
915	if (ret < 0)
916		return IRQ_NONE;
917
918	if (srcs & BAM_IRQ) {
919		clr_mask = readl_relaxed(bam_addr(bdev, 0, BAM_IRQ_STTS));
920
921		/*
922		 * don't allow reorder of the various accesses to the BAM
923		 * registers
924		 */
925		mb();
926
927		writel_relaxed(clr_mask, bam_addr(bdev, 0, BAM_IRQ_CLR));
928	}
929
930	pm_runtime_mark_last_busy(bdev->dev);
931	pm_runtime_put_autosuspend(bdev->dev);
932
933	return IRQ_HANDLED;
934}
935
936/**
937 * bam_tx_status - returns status of transaction
938 * @chan: dma channel
939 * @cookie: transaction cookie
940 * @txstate: DMA transaction state
941 *
942 * Return status of dma transaction
943 */
944static enum dma_status bam_tx_status(struct dma_chan *chan, dma_cookie_t cookie,
945		struct dma_tx_state *txstate)
946{
947	struct bam_chan *bchan = to_bam_chan(chan);
948	struct bam_async_desc *async_desc;
949	struct virt_dma_desc *vd;
950	int ret;
951	size_t residue = 0;
952	unsigned int i;
953	unsigned long flags;
954
955	ret = dma_cookie_status(chan, cookie, txstate);
956	if (ret == DMA_COMPLETE)
957		return ret;
958
959	if (!txstate)
960		return bchan->paused ? DMA_PAUSED : ret;
961
962	spin_lock_irqsave(&bchan->vc.lock, flags);
963	vd = vchan_find_desc(&bchan->vc, cookie);
964	if (vd) {
965		residue = container_of(vd, struct bam_async_desc, vd)->length;
966	} else {
967		list_for_each_entry(async_desc, &bchan->desc_list, desc_node) {
968			if (async_desc->vd.tx.cookie != cookie)
969				continue;
970
971			for (i = 0; i < async_desc->num_desc; i++)
972				residue += le16_to_cpu(
973						async_desc->curr_desc[i].size);
974		}
975	}
976
977	spin_unlock_irqrestore(&bchan->vc.lock, flags);
978
979	dma_set_residue(txstate, residue);
980
981	if (ret == DMA_IN_PROGRESS && bchan->paused)
982		ret = DMA_PAUSED;
983
984	return ret;
985}
986
987/**
988 * bam_apply_new_config
989 * @bchan: bam dma channel
990 * @dir: DMA direction
991 */
992static void bam_apply_new_config(struct bam_chan *bchan,
993	enum dma_transfer_direction dir)
994{
995	struct bam_device *bdev = bchan->bdev;
996	u32 maxburst;
997
998	if (!bdev->controlled_remotely) {
999		if (dir == DMA_DEV_TO_MEM)
1000			maxburst = bchan->slave.src_maxburst;
1001		else
1002			maxburst = bchan->slave.dst_maxburst;
1003
1004		writel_relaxed(maxburst,
1005			       bam_addr(bdev, 0, BAM_DESC_CNT_TRSHLD));
1006	}
1007
1008	bchan->reconfigure = 0;
1009}
1010
1011/**
1012 * bam_start_dma - start next transaction
1013 * @bchan: bam dma channel
1014 */
1015static void bam_start_dma(struct bam_chan *bchan)
1016{
1017	struct virt_dma_desc *vd = vchan_next_desc(&bchan->vc);
1018	struct bam_device *bdev = bchan->bdev;
1019	struct bam_async_desc *async_desc = NULL;
1020	struct bam_desc_hw *desc;
1021	struct bam_desc_hw *fifo = PTR_ALIGN(bchan->fifo_virt,
1022					sizeof(struct bam_desc_hw));
1023	int ret;
1024	unsigned int avail;
1025	struct dmaengine_desc_callback cb;
1026
1027	lockdep_assert_held(&bchan->vc.lock);
1028
1029	if (!vd)
1030		return;
1031
1032	ret = pm_runtime_get_sync(bdev->dev);
1033	if (ret < 0)
1034		return;
1035
1036	while (vd && !IS_BUSY(bchan)) {
1037		list_del(&vd->node);
1038
1039		async_desc = container_of(vd, struct bam_async_desc, vd);
1040
1041		/* on first use, initialize the channel hardware */
1042		if (!bchan->initialized)
1043			bam_chan_init_hw(bchan, async_desc->dir);
1044
1045		/* apply new slave config changes, if necessary */
1046		if (bchan->reconfigure)
1047			bam_apply_new_config(bchan, async_desc->dir);
1048
1049		desc = async_desc->curr_desc;
1050		avail = CIRC_SPACE(bchan->tail, bchan->head,
1051				   MAX_DESCRIPTORS + 1);
1052
1053		if (async_desc->num_desc > avail)
1054			async_desc->xfer_len = avail;
1055		else
1056			async_desc->xfer_len = async_desc->num_desc;
1057
1058		/* set any special flags on the last descriptor */
1059		if (async_desc->num_desc == async_desc->xfer_len)
1060			desc[async_desc->xfer_len - 1].flags |=
1061						cpu_to_le16(async_desc->flags);
1062
1063		vd = vchan_next_desc(&bchan->vc);
1064
1065		dmaengine_desc_get_callback(&async_desc->vd.tx, &cb);
1066
1067		/*
1068		 * An interrupt is generated at this desc, if
1069		 *  - FIFO is FULL.
1070		 *  - No more descriptors to add.
1071		 *  - If a callback completion was requested for this DESC,
1072		 *     In this case, BAM will deliver the completion callback
1073		 *     for this desc and continue processing the next desc.
1074		 */
1075		if (((avail <= async_desc->xfer_len) || !vd ||
1076		     dmaengine_desc_callback_valid(&cb)) &&
1077		    !(async_desc->flags & DESC_FLAG_EOT))
1078			desc[async_desc->xfer_len - 1].flags |=
1079				cpu_to_le16(DESC_FLAG_INT);
1080
1081		if (bchan->tail + async_desc->xfer_len > MAX_DESCRIPTORS) {
1082			u32 partial = MAX_DESCRIPTORS - bchan->tail;
1083
1084			memcpy(&fifo[bchan->tail], desc,
1085			       partial * sizeof(struct bam_desc_hw));
1086			memcpy(fifo, &desc[partial],
1087			       (async_desc->xfer_len - partial) *
1088				sizeof(struct bam_desc_hw));
1089		} else {
1090			memcpy(&fifo[bchan->tail], desc,
1091			       async_desc->xfer_len *
1092			       sizeof(struct bam_desc_hw));
1093		}
1094
1095		bchan->tail += async_desc->xfer_len;
1096		bchan->tail %= MAX_DESCRIPTORS;
1097		list_add_tail(&async_desc->desc_node, &bchan->desc_list);
1098	}
1099
1100	/* ensure descriptor writes and dma start not reordered */
1101	wmb();
1102	writel_relaxed(bchan->tail * sizeof(struct bam_desc_hw),
1103			bam_addr(bdev, bchan->id, BAM_P_EVNT_REG));
1104
1105	pm_runtime_mark_last_busy(bdev->dev);
1106	pm_runtime_put_autosuspend(bdev->dev);
1107}
1108
1109/**
1110 * dma_tasklet - DMA IRQ tasklet
1111 * @t: tasklet argument (bam controller structure)
1112 *
1113 * Sets up next DMA operation and then processes all completed transactions
1114 */
1115static void dma_tasklet(struct tasklet_struct *t)
1116{
1117	struct bam_device *bdev = from_tasklet(bdev, t, task);
1118	struct bam_chan *bchan;
1119	unsigned long flags;
1120	unsigned int i;
1121
1122	/* go through the channels and kick off transactions */
1123	for (i = 0; i < bdev->num_channels; i++) {
1124		bchan = &bdev->channels[i];
1125		spin_lock_irqsave(&bchan->vc.lock, flags);
1126
1127		if (!list_empty(&bchan->vc.desc_issued) && !IS_BUSY(bchan))
1128			bam_start_dma(bchan);
1129		spin_unlock_irqrestore(&bchan->vc.lock, flags);
1130	}
1131
1132}
1133
1134/**
1135 * bam_issue_pending - starts pending transactions
1136 * @chan: dma channel
1137 *
1138 * Calls tasklet directly which in turn starts any pending transactions
1139 */
1140static void bam_issue_pending(struct dma_chan *chan)
1141{
1142	struct bam_chan *bchan = to_bam_chan(chan);
1143	unsigned long flags;
1144
1145	spin_lock_irqsave(&bchan->vc.lock, flags);
1146
1147	/* if work pending and idle, start a transaction */
1148	if (vchan_issue_pending(&bchan->vc) && !IS_BUSY(bchan))
1149		bam_start_dma(bchan);
1150
1151	spin_unlock_irqrestore(&bchan->vc.lock, flags);
1152}
1153
1154/**
1155 * bam_dma_free_desc - free descriptor memory
1156 * @vd: virtual descriptor
1157 *
1158 */
1159static void bam_dma_free_desc(struct virt_dma_desc *vd)
1160{
1161	struct bam_async_desc *async_desc = container_of(vd,
1162			struct bam_async_desc, vd);
1163
1164	kfree(async_desc);
1165}
1166
1167static struct dma_chan *bam_dma_xlate(struct of_phandle_args *dma_spec,
1168		struct of_dma *of)
1169{
1170	struct bam_device *bdev = container_of(of->of_dma_data,
1171					struct bam_device, common);
1172	unsigned int request;
1173
1174	if (dma_spec->args_count != 1)
1175		return NULL;
1176
1177	request = dma_spec->args[0];
1178	if (request >= bdev->num_channels)
1179		return NULL;
1180
1181	return dma_get_slave_channel(&(bdev->channels[request].vc.chan));
1182}
1183
1184/**
1185 * bam_init
1186 * @bdev: bam device
1187 *
1188 * Initialization helper for global bam registers
1189 */
1190static int bam_init(struct bam_device *bdev)
1191{
1192	u32 val;
1193
1194	/* read revision and configuration information */
1195	if (!bdev->num_ees) {
1196		val = readl_relaxed(bam_addr(bdev, 0, BAM_REVISION));
1197		bdev->num_ees = (val >> NUM_EES_SHIFT) & NUM_EES_MASK;
1198	}
1199
1200	/* check that configured EE is within range */
1201	if (bdev->ee >= bdev->num_ees)
1202		return -EINVAL;
1203
1204	if (!bdev->num_channels) {
1205		val = readl_relaxed(bam_addr(bdev, 0, BAM_NUM_PIPES));
1206		bdev->num_channels = val & BAM_NUM_PIPES_MASK;
1207	}
1208
1209	/* Reset BAM now if fully controlled locally */
1210	if (!bdev->controlled_remotely && !bdev->powered_remotely)
1211		bam_reset(bdev);
1212
1213	return 0;
1214}
1215
1216static void bam_channel_init(struct bam_device *bdev, struct bam_chan *bchan,
1217	u32 index)
1218{
1219	bchan->id = index;
1220	bchan->bdev = bdev;
1221
1222	vchan_init(&bchan->vc, &bdev->common);
1223	bchan->vc.desc_free = bam_dma_free_desc;
1224	INIT_LIST_HEAD(&bchan->desc_list);
1225}
1226
1227static const struct of_device_id bam_of_match[] = {
1228	{ .compatible = "qcom,bam-v1.3.0", .data = &bam_v1_3_reg_info },
1229	{ .compatible = "qcom,bam-v1.4.0", .data = &bam_v1_4_reg_info },
1230	{ .compatible = "qcom,bam-v1.7.0", .data = &bam_v1_7_reg_info },
1231	{}
1232};
1233
1234MODULE_DEVICE_TABLE(of, bam_of_match);
1235
1236static int bam_dma_probe(struct platform_device *pdev)
1237{
1238	struct bam_device *bdev;
1239	const struct of_device_id *match;
1240	int ret, i;
1241
1242	bdev = devm_kzalloc(&pdev->dev, sizeof(*bdev), GFP_KERNEL);
1243	if (!bdev)
1244		return -ENOMEM;
1245
1246	bdev->dev = &pdev->dev;
1247
1248	match = of_match_node(bam_of_match, pdev->dev.of_node);
1249	if (!match) {
1250		dev_err(&pdev->dev, "Unsupported BAM module\n");
1251		return -ENODEV;
1252	}
1253
1254	bdev->layout = match->data;
1255
1256	bdev->regs = devm_platform_ioremap_resource(pdev, 0);
1257	if (IS_ERR(bdev->regs))
1258		return PTR_ERR(bdev->regs);
1259
1260	bdev->irq = platform_get_irq(pdev, 0);
1261	if (bdev->irq < 0)
1262		return bdev->irq;
1263
1264	ret = of_property_read_u32(pdev->dev.of_node, "qcom,ee", &bdev->ee);
1265	if (ret) {
1266		dev_err(bdev->dev, "Execution environment unspecified\n");
1267		return ret;
1268	}
1269
1270	bdev->controlled_remotely = of_property_read_bool(pdev->dev.of_node,
1271						"qcom,controlled-remotely");
1272	bdev->powered_remotely = of_property_read_bool(pdev->dev.of_node,
1273						"qcom,powered-remotely");
1274
1275	if (bdev->controlled_remotely || bdev->powered_remotely)
1276		bdev->bamclk = devm_clk_get_optional(bdev->dev, "bam_clk");
1277	else
1278		bdev->bamclk = devm_clk_get(bdev->dev, "bam_clk");
1279
1280	if (IS_ERR(bdev->bamclk))
1281		return PTR_ERR(bdev->bamclk);
1282
1283	if (!bdev->bamclk) {
1284		ret = of_property_read_u32(pdev->dev.of_node, "num-channels",
1285					   &bdev->num_channels);
1286		if (ret)
1287			dev_err(bdev->dev, "num-channels unspecified in dt\n");
1288
1289		ret = of_property_read_u32(pdev->dev.of_node, "qcom,num-ees",
1290					   &bdev->num_ees);
1291		if (ret)
1292			dev_err(bdev->dev, "num-ees unspecified in dt\n");
1293	}
1294
1295	ret = clk_prepare_enable(bdev->bamclk);
1296	if (ret) {
1297		dev_err(bdev->dev, "failed to prepare/enable clock\n");
1298		return ret;
1299	}
1300
1301	ret = bam_init(bdev);
1302	if (ret)
1303		goto err_disable_clk;
1304
1305	tasklet_setup(&bdev->task, dma_tasklet);
1306
1307	bdev->channels = devm_kcalloc(bdev->dev, bdev->num_channels,
1308				sizeof(*bdev->channels), GFP_KERNEL);
1309
1310	if (!bdev->channels) {
1311		ret = -ENOMEM;
1312		goto err_tasklet_kill;
1313	}
1314
1315	/* allocate and initialize channels */
1316	INIT_LIST_HEAD(&bdev->common.channels);
1317
1318	for (i = 0; i < bdev->num_channels; i++)
1319		bam_channel_init(bdev, &bdev->channels[i], i);
1320
1321	ret = devm_request_irq(bdev->dev, bdev->irq, bam_dma_irq,
1322			IRQF_TRIGGER_HIGH, "bam_dma", bdev);
1323	if (ret)
1324		goto err_bam_channel_exit;
1325
1326	/* set max dma segment size */
1327	bdev->common.dev = bdev->dev;
1328	ret = dma_set_max_seg_size(bdev->common.dev, BAM_FIFO_SIZE);
1329	if (ret) {
1330		dev_err(bdev->dev, "cannot set maximum segment size\n");
1331		goto err_bam_channel_exit;
1332	}
1333
1334	platform_set_drvdata(pdev, bdev);
1335
1336	/* set capabilities */
1337	dma_cap_zero(bdev->common.cap_mask);
1338	dma_cap_set(DMA_SLAVE, bdev->common.cap_mask);
1339
1340	/* initialize dmaengine apis */
1341	bdev->common.directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV);
1342	bdev->common.residue_granularity = DMA_RESIDUE_GRANULARITY_SEGMENT;
1343	bdev->common.src_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES;
1344	bdev->common.dst_addr_widths = DMA_SLAVE_BUSWIDTH_4_BYTES;
1345	bdev->common.device_alloc_chan_resources = bam_alloc_chan;
1346	bdev->common.device_free_chan_resources = bam_free_chan;
1347	bdev->common.device_prep_slave_sg = bam_prep_slave_sg;
1348	bdev->common.device_config = bam_slave_config;
1349	bdev->common.device_pause = bam_pause;
1350	bdev->common.device_resume = bam_resume;
1351	bdev->common.device_terminate_all = bam_dma_terminate_all;
1352	bdev->common.device_issue_pending = bam_issue_pending;
1353	bdev->common.device_tx_status = bam_tx_status;
1354	bdev->common.dev = bdev->dev;
1355
1356	ret = dma_async_device_register(&bdev->common);
1357	if (ret) {
1358		dev_err(bdev->dev, "failed to register dma async device\n");
1359		goto err_bam_channel_exit;
1360	}
1361
1362	ret = of_dma_controller_register(pdev->dev.of_node, bam_dma_xlate,
1363					&bdev->common);
1364	if (ret)
1365		goto err_unregister_dma;
1366
1367	pm_runtime_irq_safe(&pdev->dev);
1368	pm_runtime_set_autosuspend_delay(&pdev->dev, BAM_DMA_AUTOSUSPEND_DELAY);
1369	pm_runtime_use_autosuspend(&pdev->dev);
1370	pm_runtime_mark_last_busy(&pdev->dev);
1371	pm_runtime_set_active(&pdev->dev);
1372	pm_runtime_enable(&pdev->dev);
1373
1374	return 0;
1375
1376err_unregister_dma:
1377	dma_async_device_unregister(&bdev->common);
1378err_bam_channel_exit:
1379	for (i = 0; i < bdev->num_channels; i++)
1380		tasklet_kill(&bdev->channels[i].vc.task);
1381err_tasklet_kill:
1382	tasklet_kill(&bdev->task);
1383err_disable_clk:
1384	clk_disable_unprepare(bdev->bamclk);
1385
1386	return ret;
1387}
1388
1389static void bam_dma_remove(struct platform_device *pdev)
1390{
1391	struct bam_device *bdev = platform_get_drvdata(pdev);
1392	u32 i;
1393
1394	pm_runtime_force_suspend(&pdev->dev);
1395
1396	of_dma_controller_free(pdev->dev.of_node);
1397	dma_async_device_unregister(&bdev->common);
1398
1399	/* mask all interrupts for this execution environment */
1400	writel_relaxed(0, bam_addr(bdev, 0,  BAM_IRQ_SRCS_MSK_EE));
1401
1402	devm_free_irq(bdev->dev, bdev->irq, bdev);
1403
1404	for (i = 0; i < bdev->num_channels; i++) {
1405		bam_dma_terminate_all(&bdev->channels[i].vc.chan);
1406		tasklet_kill(&bdev->channels[i].vc.task);
1407
1408		if (!bdev->channels[i].fifo_virt)
1409			continue;
1410
1411		dma_free_wc(bdev->dev, BAM_DESC_FIFO_SIZE,
1412			    bdev->channels[i].fifo_virt,
1413			    bdev->channels[i].fifo_phys);
1414	}
1415
1416	tasklet_kill(&bdev->task);
1417
1418	clk_disable_unprepare(bdev->bamclk);
1419}
1420
1421static int __maybe_unused bam_dma_runtime_suspend(struct device *dev)
1422{
1423	struct bam_device *bdev = dev_get_drvdata(dev);
1424
1425	clk_disable(bdev->bamclk);
1426
1427	return 0;
1428}
1429
1430static int __maybe_unused bam_dma_runtime_resume(struct device *dev)
1431{
1432	struct bam_device *bdev = dev_get_drvdata(dev);
1433	int ret;
1434
1435	ret = clk_enable(bdev->bamclk);
1436	if (ret < 0) {
1437		dev_err(dev, "clk_enable failed: %d\n", ret);
1438		return ret;
1439	}
1440
1441	return 0;
1442}
1443
1444static int __maybe_unused bam_dma_suspend(struct device *dev)
1445{
1446	struct bam_device *bdev = dev_get_drvdata(dev);
1447
1448	pm_runtime_force_suspend(dev);
1449	clk_unprepare(bdev->bamclk);
1450
1451	return 0;
1452}
1453
1454static int __maybe_unused bam_dma_resume(struct device *dev)
1455{
1456	struct bam_device *bdev = dev_get_drvdata(dev);
1457	int ret;
1458
1459	ret = clk_prepare(bdev->bamclk);
1460	if (ret)
1461		return ret;
1462
1463	pm_runtime_force_resume(dev);
1464
1465	return 0;
1466}
1467
1468static const struct dev_pm_ops bam_dma_pm_ops = {
1469	SET_LATE_SYSTEM_SLEEP_PM_OPS(bam_dma_suspend, bam_dma_resume)
1470	SET_RUNTIME_PM_OPS(bam_dma_runtime_suspend, bam_dma_runtime_resume,
1471				NULL)
1472};
1473
1474static struct platform_driver bam_dma_driver = {
1475	.probe = bam_dma_probe,
1476	.remove_new = bam_dma_remove,
1477	.driver = {
1478		.name = "bam-dma-engine",
1479		.pm = &bam_dma_pm_ops,
1480		.of_match_table = bam_of_match,
1481	},
1482};
1483
1484module_platform_driver(bam_dma_driver);
1485
1486MODULE_AUTHOR("Andy Gross <agross@codeaurora.org>");
1487MODULE_DESCRIPTION("QCOM BAM DMA engine driver");
1488MODULE_LICENSE("GPL v2");
1489