blob: cd62bbb50e8b41b0d2b79c6e3edb571f8934f232 [file] [log] [blame]
Thomas Gleixner2874c5f2019-05-27 08:55:01 +02001// SPDX-License-Identifier: GPL-2.0-or-later
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302/*
3 * DMA driver for Xilinx Video DMA Engine
4 *
5 * Copyright (C) 2010-2014 Xilinx, Inc. All rights reserved.
6 *
7 * Based on the Freescale DMA driver.
8 *
9 * Description:
10 * The AXI Video Direct Memory Access (AXI VDMA) core is a soft Xilinx IP
11 * core that provides high-bandwidth direct memory access between memory
12 * and AXI4-Stream type video target peripherals. The core provides efficient
13 * two dimensional DMA operations with independent asynchronous read (S2MM)
14 * and write (MM2S) channel operation. It can be configured to have either
15 * one channel or two channels. If configured as two channels, one is to
16 * transmit to the video device (MM2S) and another is to receive from the
17 * video device (S2MM). Initialization, status, interrupt and management
18 * registers are accessed through an AXI4-Lite slave interface.
19 *
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +053020 * The AXI Direct Memory Access (AXI DMA) core is a soft Xilinx IP core that
21 * provides high-bandwidth one dimensional direct memory access between memory
22 * and AXI4-Stream target peripherals. It supports one receive and one
23 * transmit channel, both of them optional at synthesis time.
24 *
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +053025 * The AXI CDMA, is a soft IP, which provides high-bandwidth Direct Memory
26 * Access (DMA) between a memory-mapped source address and a memory-mapped
27 * destination address.
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +053028 *
29 * The AXI Multichannel Direct Memory Access (AXI MCDMA) core is a soft
30 * Xilinx IP that provides high-bandwidth direct memory access between
31 * memory and AXI4-Stream target peripherals. It provides scatter gather
32 * (SG) interface with multiple channels independent configuration support.
33 *
Srikanth Thokala9cd43602014-04-23 20:23:26 +053034 */
35
Srikanth Thokala9cd43602014-04-23 20:23:26 +053036#include <linux/bitops.h>
37#include <linux/dmapool.h>
Kedareswara rao Appana937abe82015-03-02 23:24:24 +053038#include <linux/dma/xilinx_dma.h>
Srikanth Thokala9cd43602014-04-23 20:23:26 +053039#include <linux/init.h>
40#include <linux/interrupt.h>
41#include <linux/io.h>
Kedareswara rao Appana9495f262016-02-26 19:33:54 +053042#include <linux/iopoll.h>
Srikanth Thokala9cd43602014-04-23 20:23:26 +053043#include <linux/module.h>
44#include <linux/of_address.h>
45#include <linux/of_dma.h>
46#include <linux/of_platform.h>
47#include <linux/of_irq.h>
48#include <linux/slab.h>
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +053049#include <linux/clk.h>
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +053050#include <linux/io-64-nonatomic-lo-hi.h>
Srikanth Thokala9cd43602014-04-23 20:23:26 +053051
52#include "../dmaengine.h"
53
54/* Register/Descriptor Offsets */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +053055#define XILINX_DMA_MM2S_CTRL_OFFSET 0x0000
56#define XILINX_DMA_S2MM_CTRL_OFFSET 0x0030
Srikanth Thokala9cd43602014-04-23 20:23:26 +053057#define XILINX_VDMA_MM2S_DESC_OFFSET 0x0050
58#define XILINX_VDMA_S2MM_DESC_OFFSET 0x00a0
59
60/* Control Registers */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +053061#define XILINX_DMA_REG_DMACR 0x0000
62#define XILINX_DMA_DMACR_DELAY_MAX 0xff
63#define XILINX_DMA_DMACR_DELAY_SHIFT 24
64#define XILINX_DMA_DMACR_FRAME_COUNT_MAX 0xff
65#define XILINX_DMA_DMACR_FRAME_COUNT_SHIFT 16
66#define XILINX_DMA_DMACR_ERR_IRQ BIT(14)
67#define XILINX_DMA_DMACR_DLY_CNT_IRQ BIT(13)
68#define XILINX_DMA_DMACR_FRM_CNT_IRQ BIT(12)
69#define XILINX_DMA_DMACR_MASTER_SHIFT 8
70#define XILINX_DMA_DMACR_FSYNCSRC_SHIFT 5
71#define XILINX_DMA_DMACR_FRAMECNT_EN BIT(4)
72#define XILINX_DMA_DMACR_GENLOCK_EN BIT(3)
73#define XILINX_DMA_DMACR_RESET BIT(2)
74#define XILINX_DMA_DMACR_CIRC_EN BIT(1)
75#define XILINX_DMA_DMACR_RUNSTOP BIT(0)
76#define XILINX_DMA_DMACR_FSYNCSRC_MASK GENMASK(6, 5)
Radhey Shyam Pandey6c6de1d2019-09-26 16:20:58 +053077#define XILINX_DMA_DMACR_DELAY_MASK GENMASK(31, 24)
78#define XILINX_DMA_DMACR_FRAME_COUNT_MASK GENMASK(23, 16)
79#define XILINX_DMA_DMACR_MASTER_MASK GENMASK(11, 8)
Srikanth Thokala9cd43602014-04-23 20:23:26 +053080
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +053081#define XILINX_DMA_REG_DMASR 0x0004
82#define XILINX_DMA_DMASR_EOL_LATE_ERR BIT(15)
83#define XILINX_DMA_DMASR_ERR_IRQ BIT(14)
84#define XILINX_DMA_DMASR_DLY_CNT_IRQ BIT(13)
85#define XILINX_DMA_DMASR_FRM_CNT_IRQ BIT(12)
86#define XILINX_DMA_DMASR_SOF_LATE_ERR BIT(11)
87#define XILINX_DMA_DMASR_SG_DEC_ERR BIT(10)
88#define XILINX_DMA_DMASR_SG_SLV_ERR BIT(9)
89#define XILINX_DMA_DMASR_EOF_EARLY_ERR BIT(8)
90#define XILINX_DMA_DMASR_SOF_EARLY_ERR BIT(7)
91#define XILINX_DMA_DMASR_DMA_DEC_ERR BIT(6)
92#define XILINX_DMA_DMASR_DMA_SLAVE_ERR BIT(5)
93#define XILINX_DMA_DMASR_DMA_INT_ERR BIT(4)
Andrea Merello05f7ea72018-11-20 16:31:49 +010094#define XILINX_DMA_DMASR_SG_MASK BIT(3)
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +053095#define XILINX_DMA_DMASR_IDLE BIT(1)
96#define XILINX_DMA_DMASR_HALTED BIT(0)
97#define XILINX_DMA_DMASR_DELAY_MASK GENMASK(31, 24)
98#define XILINX_DMA_DMASR_FRAME_COUNT_MASK GENMASK(23, 16)
Srikanth Thokala9cd43602014-04-23 20:23:26 +053099
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530100#define XILINX_DMA_REG_CURDESC 0x0008
101#define XILINX_DMA_REG_TAILDESC 0x0010
102#define XILINX_DMA_REG_REG_INDEX 0x0014
103#define XILINX_DMA_REG_FRMSTORE 0x0018
104#define XILINX_DMA_REG_THRESHOLD 0x001c
105#define XILINX_DMA_REG_FRMPTR_STS 0x0024
106#define XILINX_DMA_REG_PARK_PTR 0x0028
107#define XILINX_DMA_PARK_PTR_WR_REF_SHIFT 8
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +0530108#define XILINX_DMA_PARK_PTR_WR_REF_MASK GENMASK(12, 8)
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530109#define XILINX_DMA_PARK_PTR_RD_REF_SHIFT 0
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +0530110#define XILINX_DMA_PARK_PTR_RD_REF_MASK GENMASK(4, 0)
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530111#define XILINX_DMA_REG_VDMA_VERSION 0x002c
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530112
113/* Register Direct Mode Registers */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530114#define XILINX_DMA_REG_VSIZE 0x0000
115#define XILINX_DMA_REG_HSIZE 0x0004
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530116
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530117#define XILINX_DMA_REG_FRMDLY_STRIDE 0x0008
118#define XILINX_DMA_FRMDLY_STRIDE_FRMDLY_SHIFT 24
119#define XILINX_DMA_FRMDLY_STRIDE_STRIDE_SHIFT 0
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530120
121#define XILINX_VDMA_REG_START_ADDRESS(n) (0x000c + 4 * (n))
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530122#define XILINX_VDMA_REG_START_ADDRESS_64(n) (0x000c + 8 * (n))
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530123
Radhey Shyam Pandey0894aa22018-06-13 13:04:48 +0530124#define XILINX_VDMA_REG_ENABLE_VERTICAL_FLIP 0x00ec
125#define XILINX_VDMA_ENABLE_VERTICAL_FLIP BIT(0)
126
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530127/* HW specific definitions */
Radhey Shyam Pandey04c2bc22020-01-30 18:24:24 +0530128#define XILINX_MCDMA_MAX_CHANS_PER_DEVICE 0x20
129#define XILINX_DMA_MAX_CHANS_PER_DEVICE 0x2
130#define XILINX_CDMA_MAX_CHANS_PER_DEVICE 0x1
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530131
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530132#define XILINX_DMA_DMAXR_ALL_IRQ_MASK \
133 (XILINX_DMA_DMASR_FRM_CNT_IRQ | \
134 XILINX_DMA_DMASR_DLY_CNT_IRQ | \
135 XILINX_DMA_DMASR_ERR_IRQ)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530136
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530137#define XILINX_DMA_DMASR_ALL_ERR_MASK \
138 (XILINX_DMA_DMASR_EOL_LATE_ERR | \
139 XILINX_DMA_DMASR_SOF_LATE_ERR | \
140 XILINX_DMA_DMASR_SG_DEC_ERR | \
141 XILINX_DMA_DMASR_SG_SLV_ERR | \
142 XILINX_DMA_DMASR_EOF_EARLY_ERR | \
143 XILINX_DMA_DMASR_SOF_EARLY_ERR | \
144 XILINX_DMA_DMASR_DMA_DEC_ERR | \
145 XILINX_DMA_DMASR_DMA_SLAVE_ERR | \
146 XILINX_DMA_DMASR_DMA_INT_ERR)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530147
148/*
149 * Recoverable errors are DMA Internal error, SOF Early, EOF Early
150 * and SOF Late. They are only recoverable when C_FLUSH_ON_FSYNC
151 * is enabled in the h/w system.
152 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530153#define XILINX_DMA_DMASR_ERR_RECOVER_MASK \
154 (XILINX_DMA_DMASR_SOF_LATE_ERR | \
155 XILINX_DMA_DMASR_EOF_EARLY_ERR | \
156 XILINX_DMA_DMASR_SOF_EARLY_ERR | \
157 XILINX_DMA_DMASR_DMA_INT_ERR)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530158
159/* Axi VDMA Flush on Fsync bits */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530160#define XILINX_DMA_FLUSH_S2MM 3
161#define XILINX_DMA_FLUSH_MM2S 2
162#define XILINX_DMA_FLUSH_BOTH 1
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530163
164/* Delay loop counter to prevent hardware failure */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530165#define XILINX_DMA_LOOP_COUNT 1000000
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530166
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530167/* AXI DMA Specific Registers/Offsets */
168#define XILINX_DMA_REG_SRCDSTADDR 0x18
169#define XILINX_DMA_REG_BTT 0x28
170
171/* AXI DMA Specific Masks/Bit fields */
Radhey Shyam Pandeyae809692018-11-20 16:31:48 +0100172#define XILINX_DMA_MAX_TRANS_LEN_MIN 8
173#define XILINX_DMA_MAX_TRANS_LEN_MAX 23
174#define XILINX_DMA_V2_MAX_TRANS_LEN_MAX 26
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530175#define XILINX_DMA_CR_COALESCE_MAX GENMASK(23, 16)
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530176#define XILINX_DMA_CR_CYCLIC_BD_EN_MASK BIT(4)
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530177#define XILINX_DMA_CR_COALESCE_SHIFT 16
178#define XILINX_DMA_BD_SOP BIT(27)
179#define XILINX_DMA_BD_EOP BIT(26)
180#define XILINX_DMA_COALESCE_MAX 255
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530181#define XILINX_DMA_NUM_DESCS 255
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530182#define XILINX_DMA_NUM_APP_WORDS 5
183
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530184/* AXI CDMA Specific Registers/Offsets */
185#define XILINX_CDMA_REG_SRCADDR 0x18
186#define XILINX_CDMA_REG_DSTADDR 0x20
187
188/* AXI CDMA Specific Masks */
189#define XILINX_CDMA_CR_SGMODE BIT(3)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530190
Radhey Shyam Pandey4e47d242018-09-29 11:17:59 -0600191#define xilinx_prep_dma_addr_t(addr) \
192 ((dma_addr_t)((u64)addr##_##msb << 32 | (addr)))
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530193
194/* AXI MCDMA Specific Registers/Offsets */
195#define XILINX_MCDMA_MM2S_CTRL_OFFSET 0x0000
196#define XILINX_MCDMA_S2MM_CTRL_OFFSET 0x0500
197#define XILINX_MCDMA_CHEN_OFFSET 0x0008
198#define XILINX_MCDMA_CH_ERR_OFFSET 0x0010
199#define XILINX_MCDMA_RXINT_SER_OFFSET 0x0020
200#define XILINX_MCDMA_TXINT_SER_OFFSET 0x0028
201#define XILINX_MCDMA_CHAN_CR_OFFSET(x) (0x40 + (x) * 0x40)
202#define XILINX_MCDMA_CHAN_SR_OFFSET(x) (0x44 + (x) * 0x40)
203#define XILINX_MCDMA_CHAN_CDESC_OFFSET(x) (0x48 + (x) * 0x40)
204#define XILINX_MCDMA_CHAN_TDESC_OFFSET(x) (0x50 + (x) * 0x40)
205
206/* AXI MCDMA Specific Masks/Shifts */
207#define XILINX_MCDMA_COALESCE_SHIFT 16
208#define XILINX_MCDMA_COALESCE_MAX 24
209#define XILINX_MCDMA_IRQ_ALL_MASK GENMASK(7, 5)
210#define XILINX_MCDMA_COALESCE_MASK GENMASK(23, 16)
211#define XILINX_MCDMA_CR_RUNSTOP_MASK BIT(0)
212#define XILINX_MCDMA_IRQ_IOC_MASK BIT(5)
213#define XILINX_MCDMA_IRQ_DELAY_MASK BIT(6)
214#define XILINX_MCDMA_IRQ_ERR_MASK BIT(7)
215#define XILINX_MCDMA_BD_EOP BIT(30)
216#define XILINX_MCDMA_BD_SOP BIT(31)
217
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530218/**
219 * struct xilinx_vdma_desc_hw - Hardware Descriptor
220 * @next_desc: Next Descriptor Pointer @0x00
221 * @pad1: Reserved @0x04
222 * @buf_addr: Buffer address @0x08
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530223 * @buf_addr_msb: MSB of Buffer address @0x0C
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530224 * @vsize: Vertical Size @0x10
225 * @hsize: Horizontal Size @0x14
226 * @stride: Number of bytes between the first
227 * pixels of each horizontal line @0x18
228 */
229struct xilinx_vdma_desc_hw {
230 u32 next_desc;
231 u32 pad1;
232 u32 buf_addr;
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530233 u32 buf_addr_msb;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530234 u32 vsize;
235 u32 hsize;
236 u32 stride;
237} __aligned(64);
238
239/**
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530240 * struct xilinx_axidma_desc_hw - Hardware Descriptor for AXI DMA
241 * @next_desc: Next Descriptor Pointer @0x00
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +0530242 * @next_desc_msb: MSB of Next Descriptor Pointer @0x04
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530243 * @buf_addr: Buffer address @0x08
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +0530244 * @buf_addr_msb: MSB of Buffer address @0x0C
Radhey Shyam Pandeybcb2dc72019-10-22 22:30:20 +0530245 * @reserved1: Reserved @0x10
246 * @reserved2: Reserved @0x14
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530247 * @control: Control field @0x18
248 * @status: Status field @0x1C
249 * @app: APP Fields @0x20 - 0x30
250 */
251struct xilinx_axidma_desc_hw {
252 u32 next_desc;
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +0530253 u32 next_desc_msb;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530254 u32 buf_addr;
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +0530255 u32 buf_addr_msb;
Radhey Shyam Pandeybcb2dc72019-10-22 22:30:20 +0530256 u32 reserved1;
257 u32 reserved2;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530258 u32 control;
259 u32 status;
260 u32 app[XILINX_DMA_NUM_APP_WORDS];
261} __aligned(64);
262
263/**
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530264 * struct xilinx_aximcdma_desc_hw - Hardware Descriptor for AXI MCDMA
265 * @next_desc: Next Descriptor Pointer @0x00
266 * @next_desc_msb: MSB of Next Descriptor Pointer @0x04
267 * @buf_addr: Buffer address @0x08
268 * @buf_addr_msb: MSB of Buffer address @0x0C
269 * @rsvd: Reserved field @0x10
270 * @control: Control Information field @0x14
271 * @status: Status field @0x18
272 * @sideband_status: Status of sideband signals @0x1C
273 * @app: APP Fields @0x20 - 0x30
274 */
275struct xilinx_aximcdma_desc_hw {
276 u32 next_desc;
277 u32 next_desc_msb;
278 u32 buf_addr;
279 u32 buf_addr_msb;
280 u32 rsvd;
281 u32 control;
282 u32 status;
283 u32 sideband_status;
284 u32 app[XILINX_DMA_NUM_APP_WORDS];
285} __aligned(64);
286
287/**
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530288 * struct xilinx_cdma_desc_hw - Hardware Descriptor
289 * @next_desc: Next Descriptor Pointer @0x00
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +0530290 * @next_desc_msb: Next Descriptor Pointer MSB @0x04
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530291 * @src_addr: Source address @0x08
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +0530292 * @src_addr_msb: Source address MSB @0x0C
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530293 * @dest_addr: Destination address @0x10
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +0530294 * @dest_addr_msb: Destination address MSB @0x14
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530295 * @control: Control field @0x18
296 * @status: Status field @0x1C
297 */
298struct xilinx_cdma_desc_hw {
299 u32 next_desc;
Kedareswara rao Appana9791e712016-06-07 19:21:16 +0530300 u32 next_desc_msb;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530301 u32 src_addr;
Kedareswara rao Appana9791e712016-06-07 19:21:16 +0530302 u32 src_addr_msb;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530303 u32 dest_addr;
Kedareswara rao Appana9791e712016-06-07 19:21:16 +0530304 u32 dest_addr_msb;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530305 u32 control;
306 u32 status;
307} __aligned(64);
308
309/**
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530310 * struct xilinx_vdma_tx_segment - Descriptor segment
311 * @hw: Hardware descriptor
312 * @node: Node in the descriptor segments list
313 * @phys: Physical address of segment
314 */
315struct xilinx_vdma_tx_segment {
316 struct xilinx_vdma_desc_hw hw;
317 struct list_head node;
318 dma_addr_t phys;
319} __aligned(64);
320
321/**
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530322 * struct xilinx_axidma_tx_segment - Descriptor segment
323 * @hw: Hardware descriptor
324 * @node: Node in the descriptor segments list
325 * @phys: Physical address of segment
326 */
327struct xilinx_axidma_tx_segment {
328 struct xilinx_axidma_desc_hw hw;
329 struct list_head node;
330 dma_addr_t phys;
331} __aligned(64);
332
333/**
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530334 * struct xilinx_aximcdma_tx_segment - Descriptor segment
335 * @hw: Hardware descriptor
336 * @node: Node in the descriptor segments list
337 * @phys: Physical address of segment
338 */
339struct xilinx_aximcdma_tx_segment {
340 struct xilinx_aximcdma_desc_hw hw;
341 struct list_head node;
342 dma_addr_t phys;
343} __aligned(64);
344
345/**
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530346 * struct xilinx_cdma_tx_segment - Descriptor segment
347 * @hw: Hardware descriptor
348 * @node: Node in the descriptor segments list
349 * @phys: Physical address of segment
350 */
351struct xilinx_cdma_tx_segment {
352 struct xilinx_cdma_desc_hw hw;
353 struct list_head node;
354 dma_addr_t phys;
355} __aligned(64);
356
357/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530358 * struct xilinx_dma_tx_descriptor - Per Transaction structure
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530359 * @async_tx: Async transaction descriptor
360 * @segments: TX segments list
361 * @node: Node in the channel descriptors list
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530362 * @cyclic: Check for cyclic transfers.
Nicholas Graumannd8bae212019-10-15 20:18:22 +0530363 * @err: Whether the descriptor has an error.
364 * @residue: Residue of the completed descriptor
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530365 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530366struct xilinx_dma_tx_descriptor {
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530367 struct dma_async_tx_descriptor async_tx;
368 struct list_head segments;
369 struct list_head node;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530370 bool cyclic;
Nicholas Graumannd8bae212019-10-15 20:18:22 +0530371 bool err;
372 u32 residue;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530373};
374
375/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530376 * struct xilinx_dma_chan - Driver specific DMA channel structure
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530377 * @xdev: Driver specific device structure
378 * @ctrl_offset: Control registers offset
379 * @desc_offset: TX descriptor registers offset
380 * @lock: Descriptor operation lock
381 * @pending_list: Descriptors waiting
Kedareswara rao Appana7096f362016-02-26 19:33:51 +0530382 * @active_list: Descriptors ready to submit
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530383 * @done_list: Complete descriptors
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530384 * @free_seg_list: Free descriptors
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530385 * @common: DMA common channel
386 * @desc_pool: Descriptors pool
387 * @dev: The dma device
388 * @irq: Channel IRQ
389 * @id: Channel ID
390 * @direction: Transfer direction
391 * @num_frms: Number of frames
392 * @has_sg: Support scatter transfers
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530393 * @cyclic: Check for cyclic transfers.
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530394 * @genlock: Support genlock mode
395 * @err: Channel has errors
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +0530396 * @idle: Check for channel idle
Adrian Larumbe7dd2dd4f2021-07-07 00:43:38 +0100397 * @terminating: Check for channel being synchronized by user
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530398 * @tasklet: Cleanup work after irq
399 * @config: Device configuration info
400 * @flush_on_fsync: Flush on Frame sync
Kedareswara rao Appana7096f362016-02-26 19:33:51 +0530401 * @desc_pendingcount: Descriptor pending count
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530402 * @ext_addr: Indicates 64 bit addressing is supported by dma channel
Kedareswara rao Appanaa65cf5122016-04-06 10:38:09 +0530403 * @desc_submitcount: Descriptor h/w submitted count
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530404 * @seg_v: Statically allocated segments base
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530405 * @seg_mv: Statically allocated segments base for MCDMA
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530406 * @seg_p: Physical allocated segments base
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530407 * @cyclic_seg_v: Statically allocated segment base for cyclic transfers
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530408 * @cyclic_seg_p: Physical allocated segments base for cyclic dma
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530409 * @start_transfer: Differentiate b/w DMA IP's transfer
Akinobu Mita676f9c22017-03-14 00:59:11 +0900410 * @stop_transfer: Differentiate b/w DMA IP's quiesce
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530411 * @tdest: TDEST value for mcdma
Radhey Shyam Pandey0894aa22018-06-13 13:04:48 +0530412 * @has_vflip: S2MM vertical flip
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530413 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530414struct xilinx_dma_chan {
415 struct xilinx_dma_device *xdev;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530416 u32 ctrl_offset;
417 u32 desc_offset;
418 spinlock_t lock;
419 struct list_head pending_list;
Kedareswara rao Appana7096f362016-02-26 19:33:51 +0530420 struct list_head active_list;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530421 struct list_head done_list;
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530422 struct list_head free_seg_list;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530423 struct dma_chan common;
424 struct dma_pool *desc_pool;
425 struct device *dev;
426 int irq;
427 int id;
428 enum dma_transfer_direction direction;
429 int num_frms;
430 bool has_sg;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530431 bool cyclic;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530432 bool genlock;
433 bool err;
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +0530434 bool idle;
Adrian Larumbe7dd2dd4f2021-07-07 00:43:38 +0100435 bool terminating;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530436 struct tasklet_struct tasklet;
437 struct xilinx_vdma_config config;
438 bool flush_on_fsync;
Kedareswara rao Appana7096f362016-02-26 19:33:51 +0530439 u32 desc_pendingcount;
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530440 bool ext_addr;
Kedareswara rao Appanaa65cf5122016-04-06 10:38:09 +0530441 u32 desc_submitcount;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530442 struct xilinx_axidma_tx_segment *seg_v;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530443 struct xilinx_aximcdma_tx_segment *seg_mv;
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530444 dma_addr_t seg_p;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530445 struct xilinx_axidma_tx_segment *cyclic_seg_v;
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530446 dma_addr_t cyclic_seg_p;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530447 void (*start_transfer)(struct xilinx_dma_chan *chan);
Akinobu Mita676f9c22017-03-14 00:59:11 +0900448 int (*stop_transfer)(struct xilinx_dma_chan *chan);
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530449 u16 tdest;
Radhey Shyam Pandey0894aa22018-06-13 13:04:48 +0530450 bool has_vflip;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530451};
452
Lars-Peter Clausenf3ae7d92017-09-05 16:43:49 +0200453/**
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +0530454 * enum xdma_ip_type - DMA IP type.
Lars-Peter Clausenf3ae7d92017-09-05 16:43:49 +0200455 *
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +0530456 * @XDMA_TYPE_AXIDMA: Axi dma ip.
457 * @XDMA_TYPE_CDMA: Axi cdma ip.
458 * @XDMA_TYPE_VDMA: Axi vdma ip.
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530459 * @XDMA_TYPE_AXIMCDMA: Axi MCDMA ip.
Lars-Peter Clausenf3ae7d92017-09-05 16:43:49 +0200460 *
461 */
462enum xdma_ip_type {
463 XDMA_TYPE_AXIDMA = 0,
464 XDMA_TYPE_CDMA,
465 XDMA_TYPE_VDMA,
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530466 XDMA_TYPE_AXIMCDMA
Lars-Peter Clausenf3ae7d92017-09-05 16:43:49 +0200467};
468
Kedareswara rao Appanafb236662016-05-13 12:33:29 +0530469struct xilinx_dma_config {
470 enum xdma_ip_type dmatype;
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +0530471 int (*clk_init)(struct platform_device *pdev, struct clk **axi_clk,
472 struct clk **tx_clk, struct clk **txs_clk,
473 struct clk **rx_clk, struct clk **rxs_clk);
Radhey Shyam Pandeyc2f6b672019-10-22 22:30:21 +0530474 irqreturn_t (*irq_handler)(int irq, void *data);
Radhey Shyam Pandey04c2bc22020-01-30 18:24:24 +0530475 const int max_channels;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530476};
477
478/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530479 * struct xilinx_dma_device - DMA device structure
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530480 * @regs: I/O mapped base address
481 * @dev: Device Structure
482 * @common: DMA device structure
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530483 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530484 * @flush_on_fsync: Flush on frame sync
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530485 * @ext_addr: Indicates 64 bit addressing is supported by dma device
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +0530486 * @pdev: Platform device structure pointer
Kedareswara rao Appanafb236662016-05-13 12:33:29 +0530487 * @dma_config: DMA config structure
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +0530488 * @axi_clk: DMA Axi4-lite interace clock
489 * @tx_clk: DMA mm2s clock
490 * @txs_clk: DMA mm2s stream clock
491 * @rx_clk: DMA s2mm clock
492 * @rxs_clk: DMA s2mm stream clock
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +0530493 * @s2mm_chan_id: DMA s2mm channel identifier
494 * @mm2s_chan_id: DMA mm2s channel identifier
Andrea Merello616f0f82018-11-20 16:31:45 +0100495 * @max_buffer_len: Max buffer length
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530496 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530497struct xilinx_dma_device {
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530498 void __iomem *regs;
499 struct device *dev;
500 struct dma_device common;
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +0530501 struct xilinx_dma_chan *chan[XILINX_MCDMA_MAX_CHANS_PER_DEVICE];
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530502 u32 flush_on_fsync;
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530503 bool ext_addr;
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +0530504 struct platform_device *pdev;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +0530505 const struct xilinx_dma_config *dma_config;
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +0530506 struct clk *axi_clk;
507 struct clk *tx_clk;
508 struct clk *txs_clk;
509 struct clk *rx_clk;
510 struct clk *rxs_clk;
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +0530511 u32 s2mm_chan_id;
512 u32 mm2s_chan_id;
Andrea Merello616f0f82018-11-20 16:31:45 +0100513 u32 max_buffer_len;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530514};
515
516/* Macros */
517#define to_xilinx_chan(chan) \
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530518 container_of(chan, struct xilinx_dma_chan, common)
519#define to_dma_tx_descriptor(tx) \
520 container_of(tx, struct xilinx_dma_tx_descriptor, async_tx)
521#define xilinx_dma_poll_timeout(chan, reg, val, cond, delay_us, timeout_us) \
Marc Ferland0ba2df02020-11-04 12:30:04 +0530522 readl_poll_timeout_atomic(chan->xdev->regs + chan->ctrl_offset + reg, \
523 val, cond, delay_us, timeout_us)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530524
525/* IO accessors */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530526static inline u32 dma_read(struct xilinx_dma_chan *chan, u32 reg)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530527{
528 return ioread32(chan->xdev->regs + reg);
529}
530
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530531static inline void dma_write(struct xilinx_dma_chan *chan, u32 reg, u32 value)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530532{
533 iowrite32(value, chan->xdev->regs + reg);
534}
535
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530536static inline void vdma_desc_write(struct xilinx_dma_chan *chan, u32 reg,
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530537 u32 value)
538{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530539 dma_write(chan, chan->desc_offset + reg, value);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530540}
541
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530542static inline u32 dma_ctrl_read(struct xilinx_dma_chan *chan, u32 reg)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530543{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530544 return dma_read(chan, chan->ctrl_offset + reg);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530545}
546
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530547static inline void dma_ctrl_write(struct xilinx_dma_chan *chan, u32 reg,
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530548 u32 value)
549{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530550 dma_write(chan, chan->ctrl_offset + reg, value);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530551}
552
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530553static inline void dma_ctrl_clr(struct xilinx_dma_chan *chan, u32 reg,
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530554 u32 clr)
555{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530556 dma_ctrl_write(chan, reg, dma_ctrl_read(chan, reg) & ~clr);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530557}
558
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530559static inline void dma_ctrl_set(struct xilinx_dma_chan *chan, u32 reg,
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530560 u32 set)
561{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530562 dma_ctrl_write(chan, reg, dma_ctrl_read(chan, reg) | set);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530563}
564
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530565/**
566 * vdma_desc_write_64 - 64-bit descriptor write
567 * @chan: Driver specific VDMA channel
568 * @reg: Register to write
569 * @value_lsb: lower address of the descriptor.
570 * @value_msb: upper address of the descriptor.
571 *
572 * Since vdma driver is trying to write to a register offset which is not a
573 * multiple of 64 bits(ex : 0x5c), we are writing as two separate 32 bits
574 * instead of a single 64 bit register write.
575 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530576static inline void vdma_desc_write_64(struct xilinx_dma_chan *chan, u32 reg,
Kedareswara rao Appanab72db402016-04-06 10:38:08 +0530577 u32 value_lsb, u32 value_msb)
578{
579 /* Write the lsb 32 bits*/
580 writel(value_lsb, chan->xdev->regs + chan->desc_offset + reg);
581
582 /* Write the msb 32 bits */
583 writel(value_msb, chan->xdev->regs + chan->desc_offset + reg + 4);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530584}
585
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +0530586static inline void dma_writeq(struct xilinx_dma_chan *chan, u32 reg, u64 value)
587{
588 lo_hi_writeq(value, chan->xdev->regs + chan->ctrl_offset + reg);
589}
590
591static inline void xilinx_write(struct xilinx_dma_chan *chan, u32 reg,
592 dma_addr_t addr)
593{
594 if (chan->ext_addr)
595 dma_writeq(chan, reg, addr);
596 else
597 dma_ctrl_write(chan, reg, addr);
598}
599
600static inline void xilinx_axidma_buf(struct xilinx_dma_chan *chan,
601 struct xilinx_axidma_desc_hw *hw,
602 dma_addr_t buf_addr, size_t sg_used,
603 size_t period_len)
604{
605 if (chan->ext_addr) {
606 hw->buf_addr = lower_32_bits(buf_addr + sg_used + period_len);
607 hw->buf_addr_msb = upper_32_bits(buf_addr + sg_used +
608 period_len);
609 } else {
610 hw->buf_addr = buf_addr + sg_used + period_len;
611 }
612}
613
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530614static inline void xilinx_aximcdma_buf(struct xilinx_dma_chan *chan,
615 struct xilinx_aximcdma_desc_hw *hw,
616 dma_addr_t buf_addr, size_t sg_used)
617{
618 if (chan->ext_addr) {
619 hw->buf_addr = lower_32_bits(buf_addr + sg_used);
620 hw->buf_addr_msb = upper_32_bits(buf_addr + sg_used);
621 } else {
622 hw->buf_addr = buf_addr + sg_used;
623 }
624}
625
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530626/* -----------------------------------------------------------------------------
627 * Descriptors and segments alloc and free
628 */
629
630/**
631 * xilinx_vdma_alloc_tx_segment - Allocate transaction segment
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530632 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530633 *
634 * Return: The allocated segment on success and NULL on failure.
635 */
636static struct xilinx_vdma_tx_segment *
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530637xilinx_vdma_alloc_tx_segment(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530638{
639 struct xilinx_vdma_tx_segment *segment;
640 dma_addr_t phys;
641
Julia Lawall2ba4f8a2016-04-29 22:09:09 +0200642 segment = dma_pool_zalloc(chan->desc_pool, GFP_ATOMIC, &phys);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530643 if (!segment)
644 return NULL;
645
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530646 segment->phys = phys;
647
648 return segment;
649}
650
651/**
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530652 * xilinx_cdma_alloc_tx_segment - Allocate transaction segment
653 * @chan: Driver specific DMA channel
654 *
655 * Return: The allocated segment on success and NULL on failure.
656 */
657static struct xilinx_cdma_tx_segment *
658xilinx_cdma_alloc_tx_segment(struct xilinx_dma_chan *chan)
659{
660 struct xilinx_cdma_tx_segment *segment;
661 dma_addr_t phys;
662
Kedareswara rao Appana62147862016-05-18 13:17:31 +0530663 segment = dma_pool_zalloc(chan->desc_pool, GFP_ATOMIC, &phys);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530664 if (!segment)
665 return NULL;
666
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530667 segment->phys = phys;
668
669 return segment;
670}
671
672/**
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530673 * xilinx_axidma_alloc_tx_segment - Allocate transaction segment
674 * @chan: Driver specific DMA channel
675 *
676 * Return: The allocated segment on success and NULL on failure.
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530677 */
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530678static struct xilinx_axidma_tx_segment *
679xilinx_axidma_alloc_tx_segment(struct xilinx_dma_chan *chan)
680{
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530681 struct xilinx_axidma_tx_segment *segment = NULL;
682 unsigned long flags;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530683
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530684 spin_lock_irqsave(&chan->lock, flags);
685 if (!list_empty(&chan->free_seg_list)) {
686 segment = list_first_entry(&chan->free_seg_list,
687 struct xilinx_axidma_tx_segment,
688 node);
689 list_del(&segment->node);
690 }
691 spin_unlock_irqrestore(&chan->lock, flags);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530692
Nicholas Graumann722b9e6d2019-10-15 20:18:23 +0530693 if (!segment)
694 dev_dbg(chan->dev, "Could not find free tx segment\n");
695
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530696 return segment;
697}
698
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530699/**
700 * xilinx_aximcdma_alloc_tx_segment - Allocate transaction segment
701 * @chan: Driver specific DMA channel
702 *
703 * Return: The allocated segment on success and NULL on failure.
704 */
705static struct xilinx_aximcdma_tx_segment *
706xilinx_aximcdma_alloc_tx_segment(struct xilinx_dma_chan *chan)
707{
708 struct xilinx_aximcdma_tx_segment *segment = NULL;
709 unsigned long flags;
710
711 spin_lock_irqsave(&chan->lock, flags);
712 if (!list_empty(&chan->free_seg_list)) {
713 segment = list_first_entry(&chan->free_seg_list,
714 struct xilinx_aximcdma_tx_segment,
715 node);
716 list_del(&segment->node);
717 }
718 spin_unlock_irqrestore(&chan->lock, flags);
719
720 return segment;
721}
722
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530723static void xilinx_dma_clean_hw_desc(struct xilinx_axidma_desc_hw *hw)
724{
725 u32 next_desc = hw->next_desc;
726 u32 next_desc_msb = hw->next_desc_msb;
727
728 memset(hw, 0, sizeof(struct xilinx_axidma_desc_hw));
729
730 hw->next_desc = next_desc;
731 hw->next_desc_msb = next_desc_msb;
732}
733
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530734static void xilinx_mcdma_clean_hw_desc(struct xilinx_aximcdma_desc_hw *hw)
735{
736 u32 next_desc = hw->next_desc;
737 u32 next_desc_msb = hw->next_desc_msb;
738
739 memset(hw, 0, sizeof(struct xilinx_aximcdma_desc_hw));
740
741 hw->next_desc = next_desc;
742 hw->next_desc_msb = next_desc_msb;
743}
744
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530745/**
746 * xilinx_dma_free_tx_segment - Free transaction segment
747 * @chan: Driver specific DMA channel
748 * @segment: DMA transaction segment
749 */
750static void xilinx_dma_free_tx_segment(struct xilinx_dma_chan *chan,
751 struct xilinx_axidma_tx_segment *segment)
752{
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530753 xilinx_dma_clean_hw_desc(&segment->hw);
754
755 list_add_tail(&segment->node, &chan->free_seg_list);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530756}
757
758/**
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530759 * xilinx_mcdma_free_tx_segment - Free transaction segment
760 * @chan: Driver specific DMA channel
761 * @segment: DMA transaction segment
762 */
763static void xilinx_mcdma_free_tx_segment(struct xilinx_dma_chan *chan,
764 struct xilinx_aximcdma_tx_segment *
765 segment)
766{
767 xilinx_mcdma_clean_hw_desc(&segment->hw);
768
769 list_add_tail(&segment->node, &chan->free_seg_list);
770}
771
772/**
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530773 * xilinx_cdma_free_tx_segment - Free transaction segment
774 * @chan: Driver specific DMA channel
775 * @segment: DMA transaction segment
776 */
777static void xilinx_cdma_free_tx_segment(struct xilinx_dma_chan *chan,
778 struct xilinx_cdma_tx_segment *segment)
779{
780 dma_pool_free(chan->desc_pool, segment, segment->phys);
781}
782
783/**
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530784 * xilinx_vdma_free_tx_segment - Free transaction segment
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530785 * @chan: Driver specific DMA channel
786 * @segment: DMA transaction segment
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530787 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530788static void xilinx_vdma_free_tx_segment(struct xilinx_dma_chan *chan,
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530789 struct xilinx_vdma_tx_segment *segment)
790{
791 dma_pool_free(chan->desc_pool, segment, segment->phys);
792}
793
794/**
Shravya Kumbhamdbe3c542021-09-13 14:58:36 +0530795 * xilinx_dma_alloc_tx_descriptor - Allocate transaction descriptor
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530796 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530797 *
798 * Return: The allocated descriptor on success and NULL on failure.
799 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530800static struct xilinx_dma_tx_descriptor *
801xilinx_dma_alloc_tx_descriptor(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530802{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530803 struct xilinx_dma_tx_descriptor *desc;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530804
Richard Fitzgeraldba61c362021-01-29 17:08:00 +0000805 desc = kzalloc(sizeof(*desc), GFP_NOWAIT);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530806 if (!desc)
807 return NULL;
808
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530809 INIT_LIST_HEAD(&desc->segments);
810
811 return desc;
812}
813
814/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530815 * xilinx_dma_free_tx_descriptor - Free transaction descriptor
816 * @chan: Driver specific DMA channel
817 * @desc: DMA transaction descriptor
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530818 */
819static void
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530820xilinx_dma_free_tx_descriptor(struct xilinx_dma_chan *chan,
821 struct xilinx_dma_tx_descriptor *desc)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530822{
823 struct xilinx_vdma_tx_segment *segment, *next;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530824 struct xilinx_cdma_tx_segment *cdma_segment, *cdma_next;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530825 struct xilinx_axidma_tx_segment *axidma_segment, *axidma_next;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530826 struct xilinx_aximcdma_tx_segment *aximcdma_segment, *aximcdma_next;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530827
828 if (!desc)
829 return;
830
Kedareswara rao Appanafb236662016-05-13 12:33:29 +0530831 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_VDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530832 list_for_each_entry_safe(segment, next, &desc->segments, node) {
833 list_del(&segment->node);
834 xilinx_vdma_free_tx_segment(chan, segment);
835 }
Kedareswara rao Appanafb236662016-05-13 12:33:29 +0530836 } else if (chan->xdev->dma_config->dmatype == XDMA_TYPE_CDMA) {
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +0530837 list_for_each_entry_safe(cdma_segment, cdma_next,
838 &desc->segments, node) {
839 list_del(&cdma_segment->node);
840 xilinx_cdma_free_tx_segment(chan, cdma_segment);
841 }
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530842 } else if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +0530843 list_for_each_entry_safe(axidma_segment, axidma_next,
844 &desc->segments, node) {
845 list_del(&axidma_segment->node);
846 xilinx_dma_free_tx_segment(chan, axidma_segment);
847 }
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530848 } else {
849 list_for_each_entry_safe(aximcdma_segment, aximcdma_next,
850 &desc->segments, node) {
851 list_del(&aximcdma_segment->node);
852 xilinx_mcdma_free_tx_segment(chan, aximcdma_segment);
853 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530854 }
855
856 kfree(desc);
857}
858
859/* Required functions */
860
861/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530862 * xilinx_dma_free_desc_list - Free descriptors list
863 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530864 * @list: List to parse and delete the descriptor
865 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530866static void xilinx_dma_free_desc_list(struct xilinx_dma_chan *chan,
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530867 struct list_head *list)
868{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530869 struct xilinx_dma_tx_descriptor *desc, *next;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530870
871 list_for_each_entry_safe(desc, next, list, node) {
872 list_del(&desc->node);
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530873 xilinx_dma_free_tx_descriptor(chan, desc);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530874 }
875}
876
877/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530878 * xilinx_dma_free_descriptors - Free channel descriptors
879 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530880 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530881static void xilinx_dma_free_descriptors(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530882{
883 unsigned long flags;
884
885 spin_lock_irqsave(&chan->lock, flags);
886
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530887 xilinx_dma_free_desc_list(chan, &chan->pending_list);
888 xilinx_dma_free_desc_list(chan, &chan->done_list);
889 xilinx_dma_free_desc_list(chan, &chan->active_list);
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530890
891 spin_unlock_irqrestore(&chan->lock, flags);
892}
893
894/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530895 * xilinx_dma_free_chan_resources - Free channel resources
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530896 * @dchan: DMA channel
897 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530898static void xilinx_dma_free_chan_resources(struct dma_chan *dchan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530899{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530900 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530901 unsigned long flags;
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530902
903 dev_dbg(chan->dev, "Free all channel resources.\n");
904
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +0530905 xilinx_dma_free_descriptors(chan);
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530906
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530907 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530908 spin_lock_irqsave(&chan->lock, flags);
909 INIT_LIST_HEAD(&chan->free_seg_list);
910 spin_unlock_irqrestore(&chan->lock, flags);
911
Kedareswara rao Appana0e847d42018-01-03 12:12:11 +0530912 /* Free memory that is allocated for BD */
913 dma_free_coherent(chan->dev, sizeof(*chan->seg_v) *
914 XILINX_DMA_NUM_DESCS, chan->seg_v,
915 chan->seg_p);
916
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530917 /* Free Memory that is allocated for cyclic DMA Mode */
918 dma_free_coherent(chan->dev, sizeof(*chan->cyclic_seg_v),
919 chan->cyclic_seg_v, chan->cyclic_seg_p);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530920 }
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530921
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530922 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA) {
923 spin_lock_irqsave(&chan->lock, flags);
924 INIT_LIST_HEAD(&chan->free_seg_list);
925 spin_unlock_irqrestore(&chan->lock, flags);
926
927 /* Free memory that is allocated for BD */
928 dma_free_coherent(chan->dev, sizeof(*chan->seg_mv) *
929 XILINX_DMA_NUM_DESCS, chan->seg_mv,
930 chan->seg_p);
931 }
932
933 if (chan->xdev->dma_config->dmatype != XDMA_TYPE_AXIDMA &&
934 chan->xdev->dma_config->dmatype != XDMA_TYPE_AXIMCDMA) {
Kedareswara rao Appana23059402017-12-07 10:51:04 +0530935 dma_pool_destroy(chan->desc_pool);
936 chan->desc_pool = NULL;
937 }
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +0530938
Srikanth Thokala9cd43602014-04-23 20:23:26 +0530939}
940
941/**
Nicholas Graumanna575d0b2019-10-15 20:18:21 +0530942 * xilinx_dma_get_residue - Compute residue for a given descriptor
943 * @chan: Driver specific dma channel
944 * @desc: dma transaction descriptor
945 *
946 * Return: The number of residue bytes for the descriptor.
947 */
948static u32 xilinx_dma_get_residue(struct xilinx_dma_chan *chan,
949 struct xilinx_dma_tx_descriptor *desc)
950{
951 struct xilinx_cdma_tx_segment *cdma_seg;
952 struct xilinx_axidma_tx_segment *axidma_seg;
Matthew Murrianc8ae7932020-11-04 12:30:05 +0530953 struct xilinx_aximcdma_tx_segment *aximcdma_seg;
Nicholas Graumanna575d0b2019-10-15 20:18:21 +0530954 struct xilinx_cdma_desc_hw *cdma_hw;
955 struct xilinx_axidma_desc_hw *axidma_hw;
Matthew Murrianc8ae7932020-11-04 12:30:05 +0530956 struct xilinx_aximcdma_desc_hw *aximcdma_hw;
Nicholas Graumanna575d0b2019-10-15 20:18:21 +0530957 struct list_head *entry;
958 u32 residue = 0;
959
960 list_for_each(entry, &desc->segments) {
961 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_CDMA) {
962 cdma_seg = list_entry(entry,
963 struct xilinx_cdma_tx_segment,
964 node);
965 cdma_hw = &cdma_seg->hw;
966 residue += (cdma_hw->control - cdma_hw->status) &
967 chan->xdev->max_buffer_len;
Matthew Murrianc8ae7932020-11-04 12:30:05 +0530968 } else if (chan->xdev->dma_config->dmatype ==
969 XDMA_TYPE_AXIDMA) {
Nicholas Graumanna575d0b2019-10-15 20:18:21 +0530970 axidma_seg = list_entry(entry,
971 struct xilinx_axidma_tx_segment,
972 node);
973 axidma_hw = &axidma_seg->hw;
974 residue += (axidma_hw->control - axidma_hw->status) &
975 chan->xdev->max_buffer_len;
Matthew Murrianc8ae7932020-11-04 12:30:05 +0530976 } else {
977 aximcdma_seg =
978 list_entry(entry,
979 struct xilinx_aximcdma_tx_segment,
980 node);
981 aximcdma_hw = &aximcdma_seg->hw;
982 residue +=
983 (aximcdma_hw->control - aximcdma_hw->status) &
984 chan->xdev->max_buffer_len;
Nicholas Graumanna575d0b2019-10-15 20:18:21 +0530985 }
986 }
987
988 return residue;
989}
990
991/**
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +0530992 * xilinx_dma_chan_handle_cyclic - Cyclic dma callback
993 * @chan: Driver specific dma channel
994 * @desc: dma transaction descriptor
995 * @flags: flags for spin lock
996 */
997static void xilinx_dma_chan_handle_cyclic(struct xilinx_dma_chan *chan,
998 struct xilinx_dma_tx_descriptor *desc,
999 unsigned long *flags)
1000{
Lars-Peter Clausena63ddc32021-10-25 09:54:27 +02001001 struct dmaengine_desc_callback cb;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301002
Lars-Peter Clausena63ddc32021-10-25 09:54:27 +02001003 dmaengine_desc_get_callback(&desc->async_tx, &cb);
1004 if (dmaengine_desc_callback_valid(&cb)) {
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301005 spin_unlock_irqrestore(&chan->lock, *flags);
Lars-Peter Clausena63ddc32021-10-25 09:54:27 +02001006 dmaengine_desc_callback_invoke(&cb, NULL);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301007 spin_lock_irqsave(&chan->lock, *flags);
1008 }
1009}
1010
1011/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301012 * xilinx_dma_chan_desc_cleanup - Clean channel descriptors
1013 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301014 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301015static void xilinx_dma_chan_desc_cleanup(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301016{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301017 struct xilinx_dma_tx_descriptor *desc, *next;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301018 unsigned long flags;
1019
1020 spin_lock_irqsave(&chan->lock, flags);
1021
1022 list_for_each_entry_safe(desc, next, &chan->done_list, node) {
Nicholas Graumannd8bae212019-10-15 20:18:22 +05301023 struct dmaengine_result result;
1024
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301025 if (desc->cyclic) {
1026 xilinx_dma_chan_handle_cyclic(chan, desc, &flags);
1027 break;
1028 }
1029
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301030 /* Remove from the list of running transactions */
1031 list_del(&desc->node);
1032
Nicholas Graumannd8bae212019-10-15 20:18:22 +05301033 if (unlikely(desc->err)) {
1034 if (chan->direction == DMA_DEV_TO_MEM)
1035 result.result = DMA_TRANS_READ_FAILED;
1036 else
1037 result.result = DMA_TRANS_WRITE_FAILED;
1038 } else {
1039 result.result = DMA_TRANS_NOERROR;
1040 }
1041
1042 result.residue = desc->residue;
1043
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301044 /* Run the link descriptor callback function */
Radhey Shyam Pandey005a0172019-10-15 20:18:18 +05301045 spin_unlock_irqrestore(&chan->lock, flags);
Nicholas Graumannd8bae212019-10-15 20:18:22 +05301046 dmaengine_desc_get_callback_invoke(&desc->async_tx, &result);
Radhey Shyam Pandey005a0172019-10-15 20:18:18 +05301047 spin_lock_irqsave(&chan->lock, flags);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301048
1049 /* Run any dependencies, then free the descriptor */
1050 dma_run_dependencies(&desc->async_tx);
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301051 xilinx_dma_free_tx_descriptor(chan, desc);
Adrian Larumbe7dd2dd4f2021-07-07 00:43:38 +01001052
1053 /*
1054 * While we ran a callback the user called a terminate function,
1055 * which takes care of cleaning up any remaining descriptors
1056 */
1057 if (chan->terminating)
1058 break;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301059 }
1060
1061 spin_unlock_irqrestore(&chan->lock, flags);
1062}
1063
1064/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301065 * xilinx_dma_do_tasklet - Schedule completion tasklet
Vinod Kould11913f2020-10-07 14:01:11 +05301066 * @t: Pointer to the Xilinx DMA channel structure
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301067 */
Allen Paisf19a11d2020-08-31 16:05:39 +05301068static void xilinx_dma_do_tasklet(struct tasklet_struct *t)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301069{
Allen Paisf19a11d2020-08-31 16:05:39 +05301070 struct xilinx_dma_chan *chan = from_tasklet(chan, t, tasklet);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301071
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301072 xilinx_dma_chan_desc_cleanup(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301073}
1074
1075/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301076 * xilinx_dma_alloc_chan_resources - Allocate channel resources
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301077 * @dchan: DMA channel
1078 *
1079 * Return: '0' on success and failure value on error
1080 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301081static int xilinx_dma_alloc_chan_resources(struct dma_chan *dchan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301082{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301083 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
Kedareswara rao Appana23059402017-12-07 10:51:04 +05301084 int i;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301085
1086 /* Has this channel already been allocated? */
1087 if (chan->desc_pool)
1088 return 0;
1089
1090 /*
1091 * We need the descriptor to be aligned to 64bytes
1092 * for meeting Xilinx VDMA specification requirement.
1093 */
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301094 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appana23059402017-12-07 10:51:04 +05301095 /* Allocate the buffer descriptors. */
Luis Chamberlain750afb02019-01-04 09:23:09 +01001096 chan->seg_v = dma_alloc_coherent(chan->dev,
1097 sizeof(*chan->seg_v) * XILINX_DMA_NUM_DESCS,
1098 &chan->seg_p, GFP_KERNEL);
Kedareswara rao Appana23059402017-12-07 10:51:04 +05301099 if (!chan->seg_v) {
1100 dev_err(chan->dev,
1101 "unable to allocate channel %d descriptors\n",
1102 chan->id);
1103 return -ENOMEM;
1104 }
Radhey Shyam Pandey91b43822018-09-29 11:17:57 -06001105 /*
1106 * For cyclic DMA mode we need to program the tail Descriptor
1107 * register with a value which is not a part of the BD chain
1108 * so allocating a desc segment during channel allocation for
1109 * programming tail descriptor.
1110 */
Luis Chamberlain750afb02019-01-04 09:23:09 +01001111 chan->cyclic_seg_v = dma_alloc_coherent(chan->dev,
1112 sizeof(*chan->cyclic_seg_v),
1113 &chan->cyclic_seg_p,
1114 GFP_KERNEL);
Radhey Shyam Pandey91b43822018-09-29 11:17:57 -06001115 if (!chan->cyclic_seg_v) {
1116 dev_err(chan->dev,
1117 "unable to allocate desc segment for cyclic DMA\n");
1118 dma_free_coherent(chan->dev, sizeof(*chan->seg_v) *
1119 XILINX_DMA_NUM_DESCS, chan->seg_v,
1120 chan->seg_p);
1121 return -ENOMEM;
1122 }
1123 chan->cyclic_seg_v->phys = chan->cyclic_seg_p;
Kedareswara rao Appana23059402017-12-07 10:51:04 +05301124
1125 for (i = 0; i < XILINX_DMA_NUM_DESCS; i++) {
1126 chan->seg_v[i].hw.next_desc =
1127 lower_32_bits(chan->seg_p + sizeof(*chan->seg_v) *
1128 ((i + 1) % XILINX_DMA_NUM_DESCS));
1129 chan->seg_v[i].hw.next_desc_msb =
1130 upper_32_bits(chan->seg_p + sizeof(*chan->seg_v) *
1131 ((i + 1) % XILINX_DMA_NUM_DESCS));
1132 chan->seg_v[i].phys = chan->seg_p +
1133 sizeof(*chan->seg_v) * i;
1134 list_add_tail(&chan->seg_v[i].node,
1135 &chan->free_seg_list);
1136 }
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301137 } else if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA) {
1138 /* Allocate the buffer descriptors. */
1139 chan->seg_mv = dma_alloc_coherent(chan->dev,
1140 sizeof(*chan->seg_mv) *
1141 XILINX_DMA_NUM_DESCS,
1142 &chan->seg_p, GFP_KERNEL);
1143 if (!chan->seg_mv) {
1144 dev_err(chan->dev,
1145 "unable to allocate channel %d descriptors\n",
1146 chan->id);
1147 return -ENOMEM;
1148 }
1149 for (i = 0; i < XILINX_DMA_NUM_DESCS; i++) {
1150 chan->seg_mv[i].hw.next_desc =
1151 lower_32_bits(chan->seg_p + sizeof(*chan->seg_mv) *
1152 ((i + 1) % XILINX_DMA_NUM_DESCS));
1153 chan->seg_mv[i].hw.next_desc_msb =
1154 upper_32_bits(chan->seg_p + sizeof(*chan->seg_mv) *
1155 ((i + 1) % XILINX_DMA_NUM_DESCS));
1156 chan->seg_mv[i].phys = chan->seg_p +
Matthew Murrianc8ae7932020-11-04 12:30:05 +05301157 sizeof(*chan->seg_mv) * i;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301158 list_add_tail(&chan->seg_mv[i].node,
1159 &chan->free_seg_list);
1160 }
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301161 } else if (chan->xdev->dma_config->dmatype == XDMA_TYPE_CDMA) {
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301162 chan->desc_pool = dma_pool_create("xilinx_cdma_desc_pool",
1163 chan->dev,
1164 sizeof(struct xilinx_cdma_tx_segment),
1165 __alignof__(struct xilinx_cdma_tx_segment),
1166 0);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301167 } else {
1168 chan->desc_pool = dma_pool_create("xilinx_vdma_desc_pool",
1169 chan->dev,
1170 sizeof(struct xilinx_vdma_tx_segment),
1171 __alignof__(struct xilinx_vdma_tx_segment),
1172 0);
1173 }
1174
Kedareswara rao Appana23059402017-12-07 10:51:04 +05301175 if (!chan->desc_pool &&
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301176 ((chan->xdev->dma_config->dmatype != XDMA_TYPE_AXIDMA) &&
1177 chan->xdev->dma_config->dmatype != XDMA_TYPE_AXIMCDMA)) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301178 dev_err(chan->dev,
1179 "unable to allocate channel %d descriptor pool\n",
1180 chan->id);
1181 return -ENOMEM;
1182 }
1183
1184 dma_cookie_init(dchan);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301185
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301186 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301187 /* For AXI DMA resetting once channel will reset the
1188 * other channel as well so enable the interrupts here.
1189 */
1190 dma_ctrl_set(chan, XILINX_DMA_REG_DMACR,
1191 XILINX_DMA_DMAXR_ALL_IRQ_MASK);
1192 }
1193
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301194 if ((chan->xdev->dma_config->dmatype == XDMA_TYPE_CDMA) && chan->has_sg)
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301195 dma_ctrl_set(chan, XILINX_DMA_REG_DMACR,
1196 XILINX_CDMA_CR_SGMODE);
1197
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301198 return 0;
1199}
1200
1201/**
Andrea Merello616f0f82018-11-20 16:31:45 +01001202 * xilinx_dma_calc_copysize - Calculate the amount of data to copy
1203 * @chan: Driver specific DMA channel
1204 * @size: Total data that needs to be copied
1205 * @done: Amount of data that has been already copied
1206 *
1207 * Return: Amount of data that has to be copied
1208 */
1209static int xilinx_dma_calc_copysize(struct xilinx_dma_chan *chan,
1210 int size, int done)
1211{
1212 size_t copy;
1213
1214 copy = min_t(size_t, size - done,
1215 chan->xdev->max_buffer_len);
1216
Andrea Merello5c094d42018-11-20 16:31:46 +01001217 if ((copy + done < size) &&
1218 chan->xdev->common.copy_align) {
1219 /*
1220 * If this is not the last descriptor, make sure
1221 * the next one will be properly aligned
1222 */
1223 copy = rounddown(copy,
1224 (1 << chan->xdev->common.copy_align));
1225 }
Andrea Merello616f0f82018-11-20 16:31:45 +01001226 return copy;
1227}
1228
1229/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301230 * xilinx_dma_tx_status - Get DMA transaction status
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301231 * @dchan: DMA channel
1232 * @cookie: Transaction identifier
1233 * @txstate: Transaction state
1234 *
1235 * Return: DMA transaction status
1236 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301237static enum dma_status xilinx_dma_tx_status(struct dma_chan *dchan,
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301238 dma_cookie_t cookie,
1239 struct dma_tx_state *txstate)
1240{
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301241 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
1242 struct xilinx_dma_tx_descriptor *desc;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301243 enum dma_status ret;
1244 unsigned long flags;
1245 u32 residue = 0;
1246
1247 ret = dma_cookie_status(dchan, cookie, txstate);
1248 if (ret == DMA_COMPLETE || !txstate)
1249 return ret;
1250
Nicholas Graumanna575d0b2019-10-15 20:18:21 +05301251 spin_lock_irqsave(&chan->lock, flags);
Sebastian von Ohrb2694262020-03-03 14:05:18 +01001252 if (!list_empty(&chan->active_list)) {
1253 desc = list_last_entry(&chan->active_list,
1254 struct xilinx_dma_tx_descriptor, node);
1255 /*
1256 * VDMA and simple mode do not support residue reporting, so the
1257 * residue field will always be 0.
1258 */
1259 if (chan->has_sg && chan->xdev->dma_config->dmatype != XDMA_TYPE_VDMA)
1260 residue = xilinx_dma_get_residue(chan, desc);
1261 }
Nicholas Graumanna575d0b2019-10-15 20:18:21 +05301262 spin_unlock_irqrestore(&chan->lock, flags);
1263
1264 dma_set_residue(txstate, residue);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301265
1266 return ret;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301267}
1268
1269/**
Akinobu Mita676f9c22017-03-14 00:59:11 +09001270 * xilinx_dma_stop_transfer - Halt DMA channel
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301271 * @chan: Driver specific DMA channel
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +05301272 *
1273 * Return: '0' on success and failure value on error
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301274 */
Akinobu Mita676f9c22017-03-14 00:59:11 +09001275static int xilinx_dma_stop_transfer(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301276{
Kedareswara rao Appana9495f262016-02-26 19:33:54 +05301277 u32 val;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301278
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301279 dma_ctrl_clr(chan, XILINX_DMA_REG_DMACR, XILINX_DMA_DMACR_RUNSTOP);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301280
1281 /* Wait for the hardware to halt */
Akinobu Mita676f9c22017-03-14 00:59:11 +09001282 return xilinx_dma_poll_timeout(chan, XILINX_DMA_REG_DMASR, val,
1283 val & XILINX_DMA_DMASR_HALTED, 0,
1284 XILINX_DMA_LOOP_COUNT);
1285}
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301286
Akinobu Mita676f9c22017-03-14 00:59:11 +09001287/**
1288 * xilinx_cdma_stop_transfer - Wait for the current transfer to complete
1289 * @chan: Driver specific DMA channel
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +05301290 *
1291 * Return: '0' on success and failure value on error
Akinobu Mita676f9c22017-03-14 00:59:11 +09001292 */
1293static int xilinx_cdma_stop_transfer(struct xilinx_dma_chan *chan)
1294{
1295 u32 val;
1296
1297 return xilinx_dma_poll_timeout(chan, XILINX_DMA_REG_DMASR, val,
1298 val & XILINX_DMA_DMASR_IDLE, 0,
1299 XILINX_DMA_LOOP_COUNT);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301300}
1301
1302/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301303 * xilinx_dma_start - Start DMA channel
1304 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301305 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301306static void xilinx_dma_start(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301307{
Kedareswara rao Appana69490632016-03-03 23:02:42 +05301308 int err;
Kedareswara rao Appana9495f262016-02-26 19:33:54 +05301309 u32 val;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301310
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301311 dma_ctrl_set(chan, XILINX_DMA_REG_DMACR, XILINX_DMA_DMACR_RUNSTOP);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301312
1313 /* Wait for the hardware to start */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301314 err = xilinx_dma_poll_timeout(chan, XILINX_DMA_REG_DMASR, val,
1315 !(val & XILINX_DMA_DMASR_HALTED), 0,
1316 XILINX_DMA_LOOP_COUNT);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301317
Kedareswara rao Appana9495f262016-02-26 19:33:54 +05301318 if (err) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301319 dev_err(chan->dev, "Cannot start channel %p: %x\n",
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301320 chan, dma_ctrl_read(chan, XILINX_DMA_REG_DMASR));
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301321
1322 chan->err = true;
1323 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301324}
1325
1326/**
1327 * xilinx_vdma_start_transfer - Starts VDMA transfer
1328 * @chan: Driver specific channel struct pointer
1329 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301330static void xilinx_vdma_start_transfer(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301331{
1332 struct xilinx_vdma_config *config = &chan->config;
Vinod Koulf935d7d2019-05-21 19:36:44 +05301333 struct xilinx_dma_tx_descriptor *desc;
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +05301334 u32 reg, j;
Andrea Merellob8349172018-11-20 16:31:51 +01001335 struct xilinx_vdma_tx_segment *segment, *last = NULL;
1336 int i = 0;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301337
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301338 /* This function was invoked with lock held */
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301339 if (chan->err)
1340 return;
1341
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301342 if (!chan->idle)
1343 return;
1344
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301345 if (list_empty(&chan->pending_list))
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301346 return;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301347
1348 desc = list_first_entry(&chan->pending_list,
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301349 struct xilinx_dma_tx_descriptor, node);
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301350
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301351 /* Configure the hardware using info in the config structure */
Radhey Shyam Pandey0894aa22018-06-13 13:04:48 +05301352 if (chan->has_vflip) {
1353 reg = dma_read(chan, XILINX_VDMA_REG_ENABLE_VERTICAL_FLIP);
1354 reg &= ~XILINX_VDMA_ENABLE_VERTICAL_FLIP;
1355 reg |= config->vflip_en;
1356 dma_write(chan, XILINX_VDMA_REG_ENABLE_VERTICAL_FLIP,
1357 reg);
1358 }
1359
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301360 reg = dma_ctrl_read(chan, XILINX_DMA_REG_DMACR);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301361
1362 if (config->frm_cnt_en)
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301363 reg |= XILINX_DMA_DMACR_FRAMECNT_EN;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301364 else
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301365 reg &= ~XILINX_DMA_DMACR_FRAMECNT_EN;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301366
Andrea Merellob8349172018-11-20 16:31:51 +01001367 /* If not parking, enable circular mode */
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301368 if (config->park)
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301369 reg &= ~XILINX_DMA_DMACR_CIRC_EN;
Andrea Merellob8349172018-11-20 16:31:51 +01001370 else
1371 reg |= XILINX_DMA_DMACR_CIRC_EN;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301372
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301373 dma_ctrl_write(chan, XILINX_DMA_REG_DMACR, reg);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301374
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +05301375 j = chan->desc_submitcount;
1376 reg = dma_read(chan, XILINX_DMA_REG_PARK_PTR);
1377 if (chan->direction == DMA_MEM_TO_DEV) {
1378 reg &= ~XILINX_DMA_PARK_PTR_RD_REF_MASK;
1379 reg |= j << XILINX_DMA_PARK_PTR_RD_REF_SHIFT;
1380 } else {
1381 reg &= ~XILINX_DMA_PARK_PTR_WR_REF_MASK;
1382 reg |= j << XILINX_DMA_PARK_PTR_WR_REF_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301383 }
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +05301384 dma_write(chan, XILINX_DMA_REG_PARK_PTR, reg);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301385
1386 /* Start the hardware */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301387 xilinx_dma_start(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301388
1389 if (chan->err)
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301390 return;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301391
1392 /* Start the transfer */
Andrea Merellob8349172018-11-20 16:31:51 +01001393 if (chan->desc_submitcount < chan->num_frms)
1394 i = chan->desc_submitcount;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301395
Andrea Merellob8349172018-11-20 16:31:51 +01001396 list_for_each_entry(segment, &desc->segments, node) {
1397 if (chan->ext_addr)
1398 vdma_desc_write_64(chan,
1399 XILINX_VDMA_REG_START_ADDRESS_64(i++),
1400 segment->hw.buf_addr,
1401 segment->hw.buf_addr_msb);
1402 else
1403 vdma_desc_write(chan,
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301404 XILINX_VDMA_REG_START_ADDRESS(i++),
1405 segment->hw.buf_addr);
Kedareswara rao Appanab72db402016-04-06 10:38:08 +05301406
Andrea Merellob8349172018-11-20 16:31:51 +01001407 last = segment;
Kedareswara rao Appanaa65cf5122016-04-06 10:38:09 +05301408 }
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301409
Andrea Merellob8349172018-11-20 16:31:51 +01001410 if (!last)
1411 return;
1412
1413 /* HW expects these parameters to be same for one transaction */
1414 vdma_desc_write(chan, XILINX_DMA_REG_HSIZE, last->hw.hsize);
1415 vdma_desc_write(chan, XILINX_DMA_REG_FRMDLY_STRIDE,
1416 last->hw.stride);
1417 vdma_desc_write(chan, XILINX_DMA_REG_VSIZE, last->hw.vsize);
1418
1419 chan->desc_submitcount++;
1420 chan->desc_pendingcount--;
Baokun Li75ba9a72021-06-08 11:09:05 +08001421 list_move_tail(&desc->node, &chan->active_list);
Andrea Merellob8349172018-11-20 16:31:51 +01001422 if (chan->desc_submitcount == chan->num_frms)
1423 chan->desc_submitcount = 0;
1424
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301425 chan->idle = false;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301426}
1427
1428/**
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301429 * xilinx_cdma_start_transfer - Starts cdma transfer
1430 * @chan: Driver specific channel struct pointer
1431 */
1432static void xilinx_cdma_start_transfer(struct xilinx_dma_chan *chan)
1433{
1434 struct xilinx_dma_tx_descriptor *head_desc, *tail_desc;
1435 struct xilinx_cdma_tx_segment *tail_segment;
1436 u32 ctrl_reg = dma_read(chan, XILINX_DMA_REG_DMACR);
1437
1438 if (chan->err)
1439 return;
1440
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301441 if (!chan->idle)
1442 return;
1443
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301444 if (list_empty(&chan->pending_list))
1445 return;
1446
1447 head_desc = list_first_entry(&chan->pending_list,
1448 struct xilinx_dma_tx_descriptor, node);
1449 tail_desc = list_last_entry(&chan->pending_list,
1450 struct xilinx_dma_tx_descriptor, node);
1451 tail_segment = list_last_entry(&tail_desc->segments,
1452 struct xilinx_cdma_tx_segment, node);
1453
1454 if (chan->desc_pendingcount <= XILINX_DMA_COALESCE_MAX) {
1455 ctrl_reg &= ~XILINX_DMA_CR_COALESCE_MAX;
1456 ctrl_reg |= chan->desc_pendingcount <<
1457 XILINX_DMA_CR_COALESCE_SHIFT;
1458 dma_ctrl_write(chan, XILINX_DMA_REG_DMACR, ctrl_reg);
1459 }
1460
1461 if (chan->has_sg) {
Kedareswara rao Appana48c62fb2018-01-03 12:12:09 +05301462 dma_ctrl_clr(chan, XILINX_DMA_REG_DMACR,
1463 XILINX_CDMA_CR_SGMODE);
1464
1465 dma_ctrl_set(chan, XILINX_DMA_REG_DMACR,
1466 XILINX_CDMA_CR_SGMODE);
1467
Kedareswara rao Appana9791e712016-06-07 19:21:16 +05301468 xilinx_write(chan, XILINX_DMA_REG_CURDESC,
1469 head_desc->async_tx.phys);
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301470
1471 /* Update tail ptr register which will start the transfer */
Kedareswara rao Appana9791e712016-06-07 19:21:16 +05301472 xilinx_write(chan, XILINX_DMA_REG_TAILDESC,
1473 tail_segment->phys);
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301474 } else {
1475 /* In simple mode */
1476 struct xilinx_cdma_tx_segment *segment;
1477 struct xilinx_cdma_desc_hw *hw;
1478
1479 segment = list_first_entry(&head_desc->segments,
1480 struct xilinx_cdma_tx_segment,
1481 node);
1482
1483 hw = &segment->hw;
1484
Radhey Shyam Pandey0e03aca2018-09-29 11:18:00 -06001485 xilinx_write(chan, XILINX_CDMA_REG_SRCADDR,
1486 xilinx_prep_dma_addr_t(hw->src_addr));
1487 xilinx_write(chan, XILINX_CDMA_REG_DSTADDR,
1488 xilinx_prep_dma_addr_t(hw->dest_addr));
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301489
1490 /* Start the transfer */
1491 dma_ctrl_write(chan, XILINX_DMA_REG_BTT,
Andrea Merello616f0f82018-11-20 16:31:45 +01001492 hw->control & chan->xdev->max_buffer_len);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301493 }
1494
1495 list_splice_tail_init(&chan->pending_list, &chan->active_list);
1496 chan->desc_pendingcount = 0;
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301497 chan->idle = false;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301498}
1499
1500/**
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301501 * xilinx_dma_start_transfer - Starts DMA transfer
1502 * @chan: Driver specific channel struct pointer
1503 */
1504static void xilinx_dma_start_transfer(struct xilinx_dma_chan *chan)
1505{
1506 struct xilinx_dma_tx_descriptor *head_desc, *tail_desc;
Kedareswara rao Appana23059402017-12-07 10:51:04 +05301507 struct xilinx_axidma_tx_segment *tail_segment;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301508 u32 reg;
1509
1510 if (chan->err)
1511 return;
1512
1513 if (list_empty(&chan->pending_list))
1514 return;
1515
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301516 if (!chan->idle)
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301517 return;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301518
1519 head_desc = list_first_entry(&chan->pending_list,
1520 struct xilinx_dma_tx_descriptor, node);
1521 tail_desc = list_last_entry(&chan->pending_list,
1522 struct xilinx_dma_tx_descriptor, node);
1523 tail_segment = list_last_entry(&tail_desc->segments,
1524 struct xilinx_axidma_tx_segment, node);
1525
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301526 reg = dma_ctrl_read(chan, XILINX_DMA_REG_DMACR);
1527
1528 if (chan->desc_pendingcount <= XILINX_DMA_COALESCE_MAX) {
1529 reg &= ~XILINX_DMA_CR_COALESCE_MAX;
1530 reg |= chan->desc_pendingcount <<
1531 XILINX_DMA_CR_COALESCE_SHIFT;
1532 dma_ctrl_write(chan, XILINX_DMA_REG_DMACR, reg);
1533 }
1534
Radhey Shyam Pandeybcb2dc72019-10-22 22:30:20 +05301535 if (chan->has_sg)
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +05301536 xilinx_write(chan, XILINX_DMA_REG_CURDESC,
1537 head_desc->async_tx.phys);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301538
1539 xilinx_dma_start(chan);
1540
1541 if (chan->err)
1542 return;
1543
1544 /* Start the transfer */
Radhey Shyam Pandeybcb2dc72019-10-22 22:30:20 +05301545 if (chan->has_sg) {
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301546 if (chan->cyclic)
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +05301547 xilinx_write(chan, XILINX_DMA_REG_TAILDESC,
1548 chan->cyclic_seg_v->phys);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301549 else
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +05301550 xilinx_write(chan, XILINX_DMA_REG_TAILDESC,
1551 tail_segment->phys);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301552 } else {
1553 struct xilinx_axidma_tx_segment *segment;
1554 struct xilinx_axidma_desc_hw *hw;
1555
1556 segment = list_first_entry(&head_desc->segments,
1557 struct xilinx_axidma_tx_segment,
1558 node);
1559 hw = &segment->hw;
1560
Radhey Shyam Pandey68fe2b52019-09-26 16:20:57 +05301561 xilinx_write(chan, XILINX_DMA_REG_SRCDSTADDR,
1562 xilinx_prep_dma_addr_t(hw->buf_addr));
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301563
1564 /* Start the transfer */
1565 dma_ctrl_write(chan, XILINX_DMA_REG_BTT,
Andrea Merello616f0f82018-11-20 16:31:45 +01001566 hw->control & chan->xdev->max_buffer_len);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301567 }
1568
1569 list_splice_tail_init(&chan->pending_list, &chan->active_list);
1570 chan->desc_pendingcount = 0;
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301571 chan->idle = false;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301572}
1573
1574/**
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301575 * xilinx_mcdma_start_transfer - Starts MCDMA transfer
1576 * @chan: Driver specific channel struct pointer
1577 */
1578static void xilinx_mcdma_start_transfer(struct xilinx_dma_chan *chan)
1579{
1580 struct xilinx_dma_tx_descriptor *head_desc, *tail_desc;
Matthew Murrianc8ae7932020-11-04 12:30:05 +05301581 struct xilinx_aximcdma_tx_segment *tail_segment;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301582 u32 reg;
1583
1584 /*
1585 * lock has been held by calling functions, so we don't need it
1586 * to take it here again.
1587 */
1588
1589 if (chan->err)
1590 return;
1591
1592 if (!chan->idle)
1593 return;
1594
1595 if (list_empty(&chan->pending_list))
1596 return;
1597
1598 head_desc = list_first_entry(&chan->pending_list,
1599 struct xilinx_dma_tx_descriptor, node);
1600 tail_desc = list_last_entry(&chan->pending_list,
1601 struct xilinx_dma_tx_descriptor, node);
1602 tail_segment = list_last_entry(&tail_desc->segments,
Matthew Murrianc8ae7932020-11-04 12:30:05 +05301603 struct xilinx_aximcdma_tx_segment, node);
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301604
1605 reg = dma_ctrl_read(chan, XILINX_MCDMA_CHAN_CR_OFFSET(chan->tdest));
1606
1607 if (chan->desc_pendingcount <= XILINX_MCDMA_COALESCE_MAX) {
1608 reg &= ~XILINX_MCDMA_COALESCE_MASK;
1609 reg |= chan->desc_pendingcount <<
1610 XILINX_MCDMA_COALESCE_SHIFT;
1611 }
1612
1613 reg |= XILINX_MCDMA_IRQ_ALL_MASK;
1614 dma_ctrl_write(chan, XILINX_MCDMA_CHAN_CR_OFFSET(chan->tdest), reg);
1615
1616 /* Program current descriptor */
1617 xilinx_write(chan, XILINX_MCDMA_CHAN_CDESC_OFFSET(chan->tdest),
1618 head_desc->async_tx.phys);
1619
1620 /* Program channel enable register */
1621 reg = dma_ctrl_read(chan, XILINX_MCDMA_CHEN_OFFSET);
1622 reg |= BIT(chan->tdest);
1623 dma_ctrl_write(chan, XILINX_MCDMA_CHEN_OFFSET, reg);
1624
1625 /* Start the fetch of BDs for the channel */
1626 reg = dma_ctrl_read(chan, XILINX_MCDMA_CHAN_CR_OFFSET(chan->tdest));
1627 reg |= XILINX_MCDMA_CR_RUNSTOP_MASK;
1628 dma_ctrl_write(chan, XILINX_MCDMA_CHAN_CR_OFFSET(chan->tdest), reg);
1629
1630 xilinx_dma_start(chan);
1631
1632 if (chan->err)
1633 return;
1634
1635 /* Start the transfer */
1636 xilinx_write(chan, XILINX_MCDMA_CHAN_TDESC_OFFSET(chan->tdest),
1637 tail_segment->phys);
1638
1639 list_splice_tail_init(&chan->pending_list, &chan->active_list);
1640 chan->desc_pendingcount = 0;
1641 chan->idle = false;
1642}
1643
1644/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301645 * xilinx_dma_issue_pending - Issue pending transactions
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301646 * @dchan: DMA channel
1647 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301648static void xilinx_dma_issue_pending(struct dma_chan *dchan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301649{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301650 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301651 unsigned long flags;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301652
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301653 spin_lock_irqsave(&chan->lock, flags);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301654 chan->start_transfer(chan);
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301655 spin_unlock_irqrestore(&chan->lock, flags);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301656}
1657
1658/**
Marek Vasut4153a7f2021-08-04 21:51:40 +02001659 * xilinx_dma_device_config - Configure the DMA channel
1660 * @dchan: DMA channel
1661 * @config: channel configuration
1662 */
1663static int xilinx_dma_device_config(struct dma_chan *dchan,
1664 struct dma_slave_config *config)
1665{
1666 return 0;
1667}
1668
1669/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301670 * xilinx_dma_complete_descriptor - Mark the active descriptor as complete
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301671 * @chan : xilinx DMA channel
1672 *
1673 * CONTEXT: hardirq
1674 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301675static void xilinx_dma_complete_descriptor(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301676{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301677 struct xilinx_dma_tx_descriptor *desc, *next;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301678
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301679 /* This function was invoked with lock held */
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301680 if (list_empty(&chan->active_list))
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301681 return;
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301682
1683 list_for_each_entry_safe(desc, next, &chan->active_list, node) {
Nicholas Graumannd8bae212019-10-15 20:18:22 +05301684 if (chan->has_sg && chan->xdev->dma_config->dmatype !=
1685 XDMA_TYPE_VDMA)
1686 desc->residue = xilinx_dma_get_residue(chan, desc);
1687 else
1688 desc->residue = 0;
1689 desc->err = chan->err;
1690
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301691 list_del(&desc->node);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301692 if (!desc->cyclic)
1693 dma_cookie_complete(&desc->async_tx);
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301694 list_add_tail(&desc->node, &chan->done_list);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301695 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301696}
1697
1698/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301699 * xilinx_dma_reset - Reset DMA channel
1700 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301701 *
1702 * Return: '0' on success and failure value on error
1703 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301704static int xilinx_dma_reset(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301705{
Kedareswara rao Appana69490632016-03-03 23:02:42 +05301706 int err;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301707 u32 tmp;
1708
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301709 dma_ctrl_set(chan, XILINX_DMA_REG_DMACR, XILINX_DMA_DMACR_RESET);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301710
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301711 /* Wait for the hardware to finish reset */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301712 err = xilinx_dma_poll_timeout(chan, XILINX_DMA_REG_DMACR, tmp,
1713 !(tmp & XILINX_DMA_DMACR_RESET), 0,
1714 XILINX_DMA_LOOP_COUNT);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301715
Kedareswara rao Appana9495f262016-02-26 19:33:54 +05301716 if (err) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301717 dev_err(chan->dev, "reset timeout, cr %x, sr %x\n",
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301718 dma_ctrl_read(chan, XILINX_DMA_REG_DMACR),
1719 dma_ctrl_read(chan, XILINX_DMA_REG_DMASR));
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301720 return -ETIMEDOUT;
1721 }
1722
1723 chan->err = false;
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301724 chan->idle = true;
Nicholas Graumann8a631a52019-10-15 20:18:24 +05301725 chan->desc_pendingcount = 0;
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +05301726 chan->desc_submitcount = 0;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301727
Kedareswara rao Appana9495f262016-02-26 19:33:54 +05301728 return err;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301729}
1730
1731/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301732 * xilinx_dma_chan_reset - Reset DMA channel and enable interrupts
1733 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301734 *
1735 * Return: '0' on success and failure value on error
1736 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301737static int xilinx_dma_chan_reset(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301738{
1739 int err;
1740
1741 /* Reset VDMA */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301742 err = xilinx_dma_reset(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301743 if (err)
1744 return err;
1745
1746 /* Enable interrupts */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301747 dma_ctrl_set(chan, XILINX_DMA_REG_DMACR,
1748 XILINX_DMA_DMAXR_ALL_IRQ_MASK);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301749
1750 return 0;
1751}
1752
1753/**
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301754 * xilinx_mcdma_irq_handler - MCDMA Interrupt handler
1755 * @irq: IRQ number
1756 * @data: Pointer to the Xilinx MCDMA channel structure
1757 *
1758 * Return: IRQ_HANDLED/IRQ_NONE
1759 */
1760static irqreturn_t xilinx_mcdma_irq_handler(int irq, void *data)
1761{
1762 struct xilinx_dma_chan *chan = data;
1763 u32 status, ser_offset, chan_sermask, chan_offset = 0, chan_id;
1764
1765 if (chan->direction == DMA_DEV_TO_MEM)
1766 ser_offset = XILINX_MCDMA_RXINT_SER_OFFSET;
1767 else
1768 ser_offset = XILINX_MCDMA_TXINT_SER_OFFSET;
1769
1770 /* Read the channel id raising the interrupt*/
1771 chan_sermask = dma_ctrl_read(chan, ser_offset);
1772 chan_id = ffs(chan_sermask);
1773
1774 if (!chan_id)
1775 return IRQ_NONE;
1776
1777 if (chan->direction == DMA_DEV_TO_MEM)
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05301778 chan_offset = chan->xdev->dma_config->max_channels / 2;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05301779
1780 chan_offset = chan_offset + (chan_id - 1);
1781 chan = chan->xdev->chan[chan_offset];
1782 /* Read the status and ack the interrupts. */
1783 status = dma_ctrl_read(chan, XILINX_MCDMA_CHAN_SR_OFFSET(chan->tdest));
1784 if (!(status & XILINX_MCDMA_IRQ_ALL_MASK))
1785 return IRQ_NONE;
1786
1787 dma_ctrl_write(chan, XILINX_MCDMA_CHAN_SR_OFFSET(chan->tdest),
1788 status & XILINX_MCDMA_IRQ_ALL_MASK);
1789
1790 if (status & XILINX_MCDMA_IRQ_ERR_MASK) {
1791 dev_err(chan->dev, "Channel %p has errors %x cdr %x tdr %x\n",
1792 chan,
1793 dma_ctrl_read(chan, XILINX_MCDMA_CH_ERR_OFFSET),
1794 dma_ctrl_read(chan, XILINX_MCDMA_CHAN_CDESC_OFFSET
1795 (chan->tdest)),
1796 dma_ctrl_read(chan, XILINX_MCDMA_CHAN_TDESC_OFFSET
1797 (chan->tdest)));
1798 chan->err = true;
1799 }
1800
1801 if (status & XILINX_MCDMA_IRQ_DELAY_MASK) {
1802 /*
1803 * Device takes too long to do the transfer when user requires
1804 * responsiveness.
1805 */
1806 dev_dbg(chan->dev, "Inter-packet latency too long\n");
1807 }
1808
1809 if (status & XILINX_MCDMA_IRQ_IOC_MASK) {
1810 spin_lock(&chan->lock);
1811 xilinx_dma_complete_descriptor(chan);
1812 chan->idle = true;
1813 chan->start_transfer(chan);
1814 spin_unlock(&chan->lock);
1815 }
1816
1817 tasklet_schedule(&chan->tasklet);
1818 return IRQ_HANDLED;
1819}
1820
1821/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301822 * xilinx_dma_irq_handler - DMA Interrupt handler
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301823 * @irq: IRQ number
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301824 * @data: Pointer to the Xilinx DMA channel structure
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301825 *
1826 * Return: IRQ_HANDLED/IRQ_NONE
1827 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301828static irqreturn_t xilinx_dma_irq_handler(int irq, void *data)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301829{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301830 struct xilinx_dma_chan *chan = data;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301831 u32 status;
1832
1833 /* Read the status and ack the interrupts. */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301834 status = dma_ctrl_read(chan, XILINX_DMA_REG_DMASR);
1835 if (!(status & XILINX_DMA_DMAXR_ALL_IRQ_MASK))
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301836 return IRQ_NONE;
1837
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301838 dma_ctrl_write(chan, XILINX_DMA_REG_DMASR,
1839 status & XILINX_DMA_DMAXR_ALL_IRQ_MASK);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301840
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301841 if (status & XILINX_DMA_DMASR_ERR_IRQ) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301842 /*
1843 * An error occurred. If C_FLUSH_ON_FSYNC is enabled and the
1844 * error is recoverable, ignore it. Otherwise flag the error.
1845 *
1846 * Only recoverable errors can be cleared in the DMASR register,
1847 * make sure not to write to other error bits to 1.
1848 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301849 u32 errors = status & XILINX_DMA_DMASR_ALL_ERR_MASK;
Kedareswara rao Appana48a59ed2016-04-06 10:44:55 +05301850
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301851 dma_ctrl_write(chan, XILINX_DMA_REG_DMASR,
1852 errors & XILINX_DMA_DMASR_ERR_RECOVER_MASK);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301853
1854 if (!chan->flush_on_fsync ||
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301855 (errors & ~XILINX_DMA_DMASR_ERR_RECOVER_MASK)) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301856 dev_err(chan->dev,
1857 "Channel %p has errors %x, cdr %x tdr %x\n",
1858 chan, errors,
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301859 dma_ctrl_read(chan, XILINX_DMA_REG_CURDESC),
1860 dma_ctrl_read(chan, XILINX_DMA_REG_TAILDESC));
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301861 chan->err = true;
1862 }
1863 }
1864
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301865 if (status & XILINX_DMA_DMASR_DLY_CNT_IRQ) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301866 /*
1867 * Device takes too long to do the transfer when user requires
1868 * responsiveness.
1869 */
1870 dev_dbg(chan->dev, "Inter-packet latency too long\n");
1871 }
1872
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301873 if (status & XILINX_DMA_DMASR_FRM_CNT_IRQ) {
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301874 spin_lock(&chan->lock);
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301875 xilinx_dma_complete_descriptor(chan);
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05301876 chan->idle = true;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301877 chan->start_transfer(chan);
Kedareswara rao Appana26c5e362016-02-26 19:33:52 +05301878 spin_unlock(&chan->lock);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301879 }
1880
1881 tasklet_schedule(&chan->tasklet);
1882 return IRQ_HANDLED;
1883}
1884
1885/**
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301886 * append_desc_queue - Queuing descriptor
1887 * @chan: Driver specific dma channel
1888 * @desc: dma transaction descriptor
1889 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301890static void append_desc_queue(struct xilinx_dma_chan *chan,
1891 struct xilinx_dma_tx_descriptor *desc)
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301892{
1893 struct xilinx_vdma_tx_segment *tail_segment;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301894 struct xilinx_dma_tx_descriptor *tail_desc;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301895 struct xilinx_axidma_tx_segment *axidma_tail_segment;
Matthew Murrianc8ae7932020-11-04 12:30:05 +05301896 struct xilinx_aximcdma_tx_segment *aximcdma_tail_segment;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301897 struct xilinx_cdma_tx_segment *cdma_tail_segment;
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301898
1899 if (list_empty(&chan->pending_list))
1900 goto append;
1901
1902 /*
1903 * Add the hardware descriptor to the chain of hardware descriptors
1904 * that already exists in memory.
1905 */
1906 tail_desc = list_last_entry(&chan->pending_list,
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301907 struct xilinx_dma_tx_descriptor, node);
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301908 if (chan->xdev->dma_config->dmatype == XDMA_TYPE_VDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301909 tail_segment = list_last_entry(&tail_desc->segments,
1910 struct xilinx_vdma_tx_segment,
1911 node);
1912 tail_segment->hw.next_desc = (u32)desc->async_tx.phys;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301913 } else if (chan->xdev->dma_config->dmatype == XDMA_TYPE_CDMA) {
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05301914 cdma_tail_segment = list_last_entry(&tail_desc->segments,
1915 struct xilinx_cdma_tx_segment,
1916 node);
1917 cdma_tail_segment->hw.next_desc = (u32)desc->async_tx.phys;
Matthew Murrianc8ae7932020-11-04 12:30:05 +05301918 } else if (chan->xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301919 axidma_tail_segment = list_last_entry(&tail_desc->segments,
1920 struct xilinx_axidma_tx_segment,
1921 node);
1922 axidma_tail_segment->hw.next_desc = (u32)desc->async_tx.phys;
Matthew Murrianc8ae7932020-11-04 12:30:05 +05301923 } else {
1924 aximcdma_tail_segment =
1925 list_last_entry(&tail_desc->segments,
1926 struct xilinx_aximcdma_tx_segment,
1927 node);
1928 aximcdma_tail_segment->hw.next_desc = (u32)desc->async_tx.phys;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05301929 }
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301930
1931 /*
1932 * Add the software descriptor and all children to the list
1933 * of pending transactions
1934 */
1935append:
1936 list_add_tail(&desc->node, &chan->pending_list);
1937 chan->desc_pendingcount++;
1938
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05301939 if (chan->has_sg && (chan->xdev->dma_config->dmatype == XDMA_TYPE_VDMA)
1940 && unlikely(chan->desc_pendingcount > chan->num_frms)) {
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301941 dev_dbg(chan->dev, "desc pendingcount is too high\n");
1942 chan->desc_pendingcount = chan->num_frms;
1943 }
1944}
1945
1946/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301947 * xilinx_dma_tx_submit - Submit DMA transaction
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301948 * @tx: Async transaction descriptor
1949 *
1950 * Return: cookie value on success and failure value on error
1951 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301952static dma_cookie_t xilinx_dma_tx_submit(struct dma_async_tx_descriptor *tx)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301953{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301954 struct xilinx_dma_tx_descriptor *desc = to_dma_tx_descriptor(tx);
1955 struct xilinx_dma_chan *chan = to_xilinx_chan(tx->chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301956 dma_cookie_t cookie;
1957 unsigned long flags;
1958 int err;
1959
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301960 if (chan->cyclic) {
1961 xilinx_dma_free_tx_descriptor(chan, desc);
1962 return -EBUSY;
1963 }
1964
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301965 if (chan->err) {
1966 /*
1967 * If reset fails, need to hard reset the system.
1968 * Channel is no longer functional
1969 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05301970 err = xilinx_dma_chan_reset(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301971 if (err < 0)
1972 return err;
1973 }
1974
1975 spin_lock_irqsave(&chan->lock, flags);
1976
1977 cookie = dma_cookie_assign(tx);
1978
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05301979 /* Put this transaction onto the tail of the pending queue */
1980 append_desc_queue(chan, desc);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301981
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05301982 if (desc->cyclic)
1983 chan->cyclic = true;
1984
Adrian Larumbe7dd2dd4f2021-07-07 00:43:38 +01001985 chan->terminating = false;
1986
Srikanth Thokala9cd43602014-04-23 20:23:26 +05301987 spin_unlock_irqrestore(&chan->lock, flags);
1988
1989 return cookie;
1990}
1991
1992/**
1993 * xilinx_vdma_dma_prep_interleaved - prepare a descriptor for a
1994 * DMA_SLAVE transaction
1995 * @dchan: DMA channel
1996 * @xt: Interleaved template pointer
1997 * @flags: transfer ack flags
1998 *
1999 * Return: Async transaction descriptor on success and NULL on failure
2000 */
2001static struct dma_async_tx_descriptor *
2002xilinx_vdma_dma_prep_interleaved(struct dma_chan *dchan,
2003 struct dma_interleaved_template *xt,
2004 unsigned long flags)
2005{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302006 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2007 struct xilinx_dma_tx_descriptor *desc;
Kedareswara rao Appana4b597c62018-01-03 12:12:10 +05302008 struct xilinx_vdma_tx_segment *segment;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302009 struct xilinx_vdma_desc_hw *hw;
2010
2011 if (!is_slave_direction(xt->dir))
2012 return NULL;
2013
2014 if (!xt->numf || !xt->sgl[0].size)
2015 return NULL;
2016
Srikanth Thokalaa5e48e22014-11-05 20:37:01 +02002017 if (xt->frame_size != 1)
2018 return NULL;
2019
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302020 /* Allocate a transaction descriptor. */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302021 desc = xilinx_dma_alloc_tx_descriptor(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302022 if (!desc)
2023 return NULL;
2024
2025 dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302026 desc->async_tx.tx_submit = xilinx_dma_tx_submit;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302027 async_tx_ack(&desc->async_tx);
2028
2029 /* Allocate the link descriptor from DMA pool */
2030 segment = xilinx_vdma_alloc_tx_segment(chan);
2031 if (!segment)
2032 goto error;
2033
2034 /* Fill in the hardware descriptor */
2035 hw = &segment->hw;
2036 hw->vsize = xt->numf;
2037 hw->hsize = xt->sgl[0].size;
Srikanth Thokala6d80f452014-11-05 20:37:02 +02002038 hw->stride = (xt->sgl[0].icg + xt->sgl[0].size) <<
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302039 XILINX_DMA_FRMDLY_STRIDE_STRIDE_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302040 hw->stride |= chan->config.frm_dly <<
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302041 XILINX_DMA_FRMDLY_STRIDE_FRMDLY_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302042
Kedareswara rao Appanab72db402016-04-06 10:38:08 +05302043 if (xt->dir != DMA_MEM_TO_DEV) {
2044 if (chan->ext_addr) {
2045 hw->buf_addr = lower_32_bits(xt->dst_start);
2046 hw->buf_addr_msb = upper_32_bits(xt->dst_start);
2047 } else {
2048 hw->buf_addr = xt->dst_start;
2049 }
2050 } else {
2051 if (chan->ext_addr) {
2052 hw->buf_addr = lower_32_bits(xt->src_start);
2053 hw->buf_addr_msb = upper_32_bits(xt->src_start);
2054 } else {
2055 hw->buf_addr = xt->src_start;
2056 }
2057 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302058
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302059 /* Insert the segment into the descriptor segments list. */
2060 list_add_tail(&segment->node, &desc->segments);
2061
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302062 /* Link the last hardware descriptor with the first. */
2063 segment = list_first_entry(&desc->segments,
2064 struct xilinx_vdma_tx_segment, node);
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05302065 desc->async_tx.phys = segment->phys;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302066
2067 return &desc->async_tx;
2068
2069error:
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302070 xilinx_dma_free_tx_descriptor(chan, desc);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302071 return NULL;
2072}
2073
2074/**
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302075 * xilinx_cdma_prep_memcpy - prepare descriptors for a memcpy transaction
2076 * @dchan: DMA channel
2077 * @dma_dst: destination address
2078 * @dma_src: source address
2079 * @len: transfer length
2080 * @flags: transfer ack flags
2081 *
2082 * Return: Async transaction descriptor on success and NULL on failure
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302083 */
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302084static struct dma_async_tx_descriptor *
2085xilinx_cdma_prep_memcpy(struct dma_chan *dchan, dma_addr_t dma_dst,
2086 dma_addr_t dma_src, size_t len, unsigned long flags)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302087{
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302088 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2089 struct xilinx_dma_tx_descriptor *desc;
Akinobu Mitadb6a3d02017-03-14 00:59:12 +09002090 struct xilinx_cdma_tx_segment *segment;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302091 struct xilinx_cdma_desc_hw *hw;
2092
Andrea Merello616f0f82018-11-20 16:31:45 +01002093 if (!len || len > chan->xdev->max_buffer_len)
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302094 return NULL;
2095
2096 desc = xilinx_dma_alloc_tx_descriptor(chan);
2097 if (!desc)
2098 return NULL;
2099
2100 dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
2101 desc->async_tx.tx_submit = xilinx_dma_tx_submit;
2102
2103 /* Allocate the link descriptor from DMA pool */
2104 segment = xilinx_cdma_alloc_tx_segment(chan);
2105 if (!segment)
2106 goto error;
2107
2108 hw = &segment->hw;
2109 hw->control = len;
2110 hw->src_addr = dma_src;
2111 hw->dest_addr = dma_dst;
Kedareswara rao Appana9791e712016-06-07 19:21:16 +05302112 if (chan->ext_addr) {
2113 hw->src_addr_msb = upper_32_bits(dma_src);
2114 hw->dest_addr_msb = upper_32_bits(dma_dst);
2115 }
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302116
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302117 /* Insert the segment into the descriptor segments list. */
2118 list_add_tail(&segment->node, &desc->segments);
2119
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302120 desc->async_tx.phys = segment->phys;
Akinobu Mitadb6a3d02017-03-14 00:59:12 +09002121 hw->next_desc = segment->phys;
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05302122
2123 return &desc->async_tx;
2124
2125error:
2126 xilinx_dma_free_tx_descriptor(chan, desc);
2127 return NULL;
2128}
2129
2130/**
Adrian Larumbe29cf37f2021-11-01 18:08:25 +00002131 * xilinx_cdma_prep_memcpy_sg - prepare descriptors for a memcpy_sg transaction
2132 * @dchan: DMA channel
2133 * @dst_sg: Destination scatter list
2134 * @dst_sg_len: Number of entries in destination scatter list
2135 * @src_sg: Source scatter list
2136 * @src_sg_len: Number of entries in source scatter list
2137 * @flags: transfer ack flags
2138 *
2139 * Return: Async transaction descriptor on success and NULL on failure
2140 */
2141static struct dma_async_tx_descriptor *xilinx_cdma_prep_memcpy_sg(
2142 struct dma_chan *dchan, struct scatterlist *dst_sg,
2143 unsigned int dst_sg_len, struct scatterlist *src_sg,
2144 unsigned int src_sg_len, unsigned long flags)
2145{
2146 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2147 struct xilinx_dma_tx_descriptor *desc;
2148 struct xilinx_cdma_tx_segment *segment, *prev = NULL;
2149 struct xilinx_cdma_desc_hw *hw;
2150 size_t len, dst_avail, src_avail;
2151 dma_addr_t dma_dst, dma_src;
2152
2153 if (unlikely(dst_sg_len == 0 || src_sg_len == 0))
2154 return NULL;
2155
2156 if (unlikely(!dst_sg || !src_sg))
2157 return NULL;
2158
2159 desc = xilinx_dma_alloc_tx_descriptor(chan);
2160 if (!desc)
2161 return NULL;
2162
2163 dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
2164 desc->async_tx.tx_submit = xilinx_dma_tx_submit;
2165
2166 dst_avail = sg_dma_len(dst_sg);
2167 src_avail = sg_dma_len(src_sg);
2168 /*
2169 * loop until there is either no more source or no more destination
2170 * scatterlist entry
2171 */
2172 while (true) {
2173 len = min_t(size_t, src_avail, dst_avail);
2174 len = min_t(size_t, len, chan->xdev->max_buffer_len);
2175 if (len == 0)
2176 goto fetch;
2177
2178 /* Allocate the link descriptor from DMA pool */
2179 segment = xilinx_cdma_alloc_tx_segment(chan);
2180 if (!segment)
2181 goto error;
2182
2183 dma_dst = sg_dma_address(dst_sg) + sg_dma_len(dst_sg) -
2184 dst_avail;
2185 dma_src = sg_dma_address(src_sg) + sg_dma_len(src_sg) -
2186 src_avail;
2187 hw = &segment->hw;
2188 hw->control = len;
2189 hw->src_addr = dma_src;
2190 hw->dest_addr = dma_dst;
2191 if (chan->ext_addr) {
2192 hw->src_addr_msb = upper_32_bits(dma_src);
2193 hw->dest_addr_msb = upper_32_bits(dma_dst);
2194 }
2195
2196 if (prev) {
2197 prev->hw.next_desc = segment->phys;
2198 if (chan->ext_addr)
2199 prev->hw.next_desc_msb =
2200 upper_32_bits(segment->phys);
2201 }
2202
2203 prev = segment;
2204 dst_avail -= len;
2205 src_avail -= len;
2206 list_add_tail(&segment->node, &desc->segments);
2207
2208fetch:
2209 /* Fetch the next dst scatterlist entry */
2210 if (dst_avail == 0) {
2211 if (dst_sg_len == 0)
2212 break;
2213 dst_sg = sg_next(dst_sg);
2214 if (dst_sg == NULL)
2215 break;
2216 dst_sg_len--;
2217 dst_avail = sg_dma_len(dst_sg);
2218 }
2219 /* Fetch the next src scatterlist entry */
2220 if (src_avail == 0) {
2221 if (src_sg_len == 0)
2222 break;
2223 src_sg = sg_next(src_sg);
2224 if (src_sg == NULL)
2225 break;
2226 src_sg_len--;
2227 src_avail = sg_dma_len(src_sg);
2228 }
2229 }
2230
2231 if (list_empty(&desc->segments)) {
2232 dev_err(chan->xdev->dev,
2233 "%s: Zero-size SG transfer requested\n", __func__);
2234 goto error;
2235 }
2236
2237 /* Link the last hardware descriptor with the first. */
2238 segment = list_first_entry(&desc->segments,
2239 struct xilinx_cdma_tx_segment, node);
2240 desc->async_tx.phys = segment->phys;
2241 prev->hw.next_desc = segment->phys;
2242
2243 return &desc->async_tx;
2244
2245error:
2246 xilinx_dma_free_tx_descriptor(chan, desc);
2247 return NULL;
2248}
2249
2250/**
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302251 * xilinx_dma_prep_slave_sg - prepare descriptors for a DMA_SLAVE transaction
2252 * @dchan: DMA channel
2253 * @sgl: scatterlist to transfer to/from
2254 * @sg_len: number of entries in @scatterlist
2255 * @direction: DMA direction
2256 * @flags: transfer ack flags
2257 * @context: APP words of the descriptor
2258 *
2259 * Return: Async transaction descriptor on success and NULL on failure
2260 */
2261static struct dma_async_tx_descriptor *xilinx_dma_prep_slave_sg(
2262 struct dma_chan *dchan, struct scatterlist *sgl, unsigned int sg_len,
2263 enum dma_transfer_direction direction, unsigned long flags,
2264 void *context)
2265{
2266 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2267 struct xilinx_dma_tx_descriptor *desc;
Kedareswara rao Appana23059402017-12-07 10:51:04 +05302268 struct xilinx_axidma_tx_segment *segment = NULL;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302269 u32 *app_w = (u32 *)context;
2270 struct scatterlist *sg;
2271 size_t copy;
2272 size_t sg_used;
2273 unsigned int i;
2274
2275 if (!is_slave_direction(direction))
2276 return NULL;
2277
2278 /* Allocate a transaction descriptor. */
2279 desc = xilinx_dma_alloc_tx_descriptor(chan);
2280 if (!desc)
2281 return NULL;
2282
2283 dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
2284 desc->async_tx.tx_submit = xilinx_dma_tx_submit;
2285
2286 /* Build transactions using information in the scatter gather list */
2287 for_each_sg(sgl, sg, sg_len, i) {
2288 sg_used = 0;
2289
2290 /* Loop until the entire scatterlist entry is used */
2291 while (sg_used < sg_dma_len(sg)) {
2292 struct xilinx_axidma_desc_hw *hw;
2293
2294 /* Get a free segment */
2295 segment = xilinx_axidma_alloc_tx_segment(chan);
2296 if (!segment)
2297 goto error;
2298
2299 /*
2300 * Calculate the maximum number of bytes to transfer,
2301 * making sure it is less than the hw limit
2302 */
Andrea Merello616f0f82018-11-20 16:31:45 +01002303 copy = xilinx_dma_calc_copysize(chan, sg_dma_len(sg),
2304 sg_used);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302305 hw = &segment->hw;
2306
2307 /* Fill in the descriptor */
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +05302308 xilinx_axidma_buf(chan, hw, sg_dma_address(sg),
2309 sg_used, 0);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302310
2311 hw->control = copy;
2312
2313 if (chan->direction == DMA_MEM_TO_DEV) {
2314 if (app_w)
2315 memcpy(hw->app, app_w, sizeof(u32) *
2316 XILINX_DMA_NUM_APP_WORDS);
2317 }
2318
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302319 sg_used += copy;
2320
2321 /*
2322 * Insert the segment into the descriptor segments
2323 * list.
2324 */
2325 list_add_tail(&segment->node, &desc->segments);
2326 }
2327 }
2328
2329 segment = list_first_entry(&desc->segments,
2330 struct xilinx_axidma_tx_segment, node);
2331 desc->async_tx.phys = segment->phys;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302332
2333 /* For the last DMA_MEM_TO_DEV transfer, set EOP */
2334 if (chan->direction == DMA_MEM_TO_DEV) {
2335 segment->hw.control |= XILINX_DMA_BD_SOP;
2336 segment = list_last_entry(&desc->segments,
2337 struct xilinx_axidma_tx_segment,
2338 node);
2339 segment->hw.control |= XILINX_DMA_BD_EOP;
2340 }
2341
2342 return &desc->async_tx;
2343
2344error:
2345 xilinx_dma_free_tx_descriptor(chan, desc);
2346 return NULL;
2347}
2348
2349/**
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302350 * xilinx_dma_prep_dma_cyclic - prepare descriptors for a DMA_SLAVE transaction
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +05302351 * @dchan: DMA channel
2352 * @buf_addr: Physical address of the buffer
2353 * @buf_len: Total length of the cyclic buffers
2354 * @period_len: length of individual cyclic buffer
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302355 * @direction: DMA direction
2356 * @flags: transfer ack flags
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +05302357 *
2358 * Return: Async transaction descriptor on success and NULL on failure
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302359 */
2360static struct dma_async_tx_descriptor *xilinx_dma_prep_dma_cyclic(
2361 struct dma_chan *dchan, dma_addr_t buf_addr, size_t buf_len,
2362 size_t period_len, enum dma_transfer_direction direction,
2363 unsigned long flags)
2364{
2365 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2366 struct xilinx_dma_tx_descriptor *desc;
2367 struct xilinx_axidma_tx_segment *segment, *head_segment, *prev = NULL;
2368 size_t copy, sg_used;
2369 unsigned int num_periods;
2370 int i;
2371 u32 reg;
2372
Arnd Bergmannf67c3bd2016-06-13 17:07:33 +02002373 if (!period_len)
2374 return NULL;
2375
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302376 num_periods = buf_len / period_len;
2377
Arnd Bergmannf67c3bd2016-06-13 17:07:33 +02002378 if (!num_periods)
2379 return NULL;
2380
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302381 if (!is_slave_direction(direction))
2382 return NULL;
2383
2384 /* Allocate a transaction descriptor. */
2385 desc = xilinx_dma_alloc_tx_descriptor(chan);
2386 if (!desc)
2387 return NULL;
2388
2389 chan->direction = direction;
2390 dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
2391 desc->async_tx.tx_submit = xilinx_dma_tx_submit;
2392
2393 for (i = 0; i < num_periods; ++i) {
2394 sg_used = 0;
2395
2396 while (sg_used < period_len) {
2397 struct xilinx_axidma_desc_hw *hw;
2398
2399 /* Get a free segment */
2400 segment = xilinx_axidma_alloc_tx_segment(chan);
2401 if (!segment)
2402 goto error;
2403
2404 /*
2405 * Calculate the maximum number of bytes to transfer,
2406 * making sure it is less than the hw limit
2407 */
Andrea Merello616f0f82018-11-20 16:31:45 +01002408 copy = xilinx_dma_calc_copysize(chan, period_len,
2409 sg_used);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302410 hw = &segment->hw;
Kedareswara rao Appanaf0cba682016-06-07 19:21:15 +05302411 xilinx_axidma_buf(chan, hw, buf_addr, sg_used,
2412 period_len * i);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302413 hw->control = copy;
2414
2415 if (prev)
2416 prev->hw.next_desc = segment->phys;
2417
2418 prev = segment;
2419 sg_used += copy;
2420
2421 /*
2422 * Insert the segment into the descriptor segments
2423 * list.
2424 */
2425 list_add_tail(&segment->node, &desc->segments);
2426 }
2427 }
2428
2429 head_segment = list_first_entry(&desc->segments,
2430 struct xilinx_axidma_tx_segment, node);
2431 desc->async_tx.phys = head_segment->phys;
2432
2433 desc->cyclic = true;
2434 reg = dma_ctrl_read(chan, XILINX_DMA_REG_DMACR);
2435 reg |= XILINX_DMA_CR_CYCLIC_BD_EN_MASK;
2436 dma_ctrl_write(chan, XILINX_DMA_REG_DMACR, reg);
2437
Kedareswara rao Appanae598e6e2016-07-09 14:09:48 +05302438 segment = list_last_entry(&desc->segments,
2439 struct xilinx_axidma_tx_segment,
2440 node);
2441 segment->hw.next_desc = (u32) head_segment->phys;
2442
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302443 /* For the last DMA_MEM_TO_DEV transfer, set EOP */
2444 if (direction == DMA_MEM_TO_DEV) {
Kedareswara rao Appanae167a0b2016-06-09 11:32:12 +05302445 head_segment->hw.control |= XILINX_DMA_BD_SOP;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302446 segment->hw.control |= XILINX_DMA_BD_EOP;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302447 }
2448
2449 return &desc->async_tx;
2450
2451error:
2452 xilinx_dma_free_tx_descriptor(chan, desc);
2453 return NULL;
2454}
2455
2456/**
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05302457 * xilinx_mcdma_prep_slave_sg - prepare descriptors for a DMA_SLAVE transaction
2458 * @dchan: DMA channel
2459 * @sgl: scatterlist to transfer to/from
2460 * @sg_len: number of entries in @scatterlist
2461 * @direction: DMA direction
2462 * @flags: transfer ack flags
2463 * @context: APP words of the descriptor
2464 *
2465 * Return: Async transaction descriptor on success and NULL on failure
2466 */
2467static struct dma_async_tx_descriptor *
2468xilinx_mcdma_prep_slave_sg(struct dma_chan *dchan, struct scatterlist *sgl,
2469 unsigned int sg_len,
2470 enum dma_transfer_direction direction,
2471 unsigned long flags, void *context)
2472{
2473 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2474 struct xilinx_dma_tx_descriptor *desc;
2475 struct xilinx_aximcdma_tx_segment *segment = NULL;
2476 u32 *app_w = (u32 *)context;
2477 struct scatterlist *sg;
2478 size_t copy;
2479 size_t sg_used;
2480 unsigned int i;
2481
2482 if (!is_slave_direction(direction))
2483 return NULL;
2484
2485 /* Allocate a transaction descriptor. */
2486 desc = xilinx_dma_alloc_tx_descriptor(chan);
2487 if (!desc)
2488 return NULL;
2489
2490 dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
2491 desc->async_tx.tx_submit = xilinx_dma_tx_submit;
2492
2493 /* Build transactions using information in the scatter gather list */
2494 for_each_sg(sgl, sg, sg_len, i) {
2495 sg_used = 0;
2496
2497 /* Loop until the entire scatterlist entry is used */
2498 while (sg_used < sg_dma_len(sg)) {
2499 struct xilinx_aximcdma_desc_hw *hw;
2500
2501 /* Get a free segment */
2502 segment = xilinx_aximcdma_alloc_tx_segment(chan);
2503 if (!segment)
2504 goto error;
2505
2506 /*
2507 * Calculate the maximum number of bytes to transfer,
2508 * making sure it is less than the hw limit
2509 */
2510 copy = min_t(size_t, sg_dma_len(sg) - sg_used,
2511 chan->xdev->max_buffer_len);
2512 hw = &segment->hw;
2513
2514 /* Fill in the descriptor */
2515 xilinx_aximcdma_buf(chan, hw, sg_dma_address(sg),
2516 sg_used);
2517 hw->control = copy;
2518
2519 if (chan->direction == DMA_MEM_TO_DEV && app_w) {
2520 memcpy(hw->app, app_w, sizeof(u32) *
2521 XILINX_DMA_NUM_APP_WORDS);
2522 }
2523
2524 sg_used += copy;
2525 /*
2526 * Insert the segment into the descriptor segments
2527 * list.
2528 */
2529 list_add_tail(&segment->node, &desc->segments);
2530 }
2531 }
2532
2533 segment = list_first_entry(&desc->segments,
2534 struct xilinx_aximcdma_tx_segment, node);
2535 desc->async_tx.phys = segment->phys;
2536
2537 /* For the last DMA_MEM_TO_DEV transfer, set EOP */
2538 if (chan->direction == DMA_MEM_TO_DEV) {
2539 segment->hw.control |= XILINX_MCDMA_BD_SOP;
2540 segment = list_last_entry(&desc->segments,
2541 struct xilinx_aximcdma_tx_segment,
2542 node);
2543 segment->hw.control |= XILINX_MCDMA_BD_EOP;
2544 }
2545
2546 return &desc->async_tx;
2547
2548error:
2549 xilinx_dma_free_tx_descriptor(chan, desc);
2550
2551 return NULL;
2552}
2553
2554/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302555 * xilinx_dma_terminate_all - Halt the channel and free descriptors
Kedareswara rao Appanae50a0ad2017-12-07 10:51:05 +05302556 * @dchan: Driver specific DMA Channel pointer
2557 *
2558 * Return: '0' always.
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302559 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302560static int xilinx_dma_terminate_all(struct dma_chan *dchan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302561{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302562 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302563 u32 reg;
Akinobu Mita676f9c22017-03-14 00:59:11 +09002564 int err;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302565
Radhey Shyam Pandey2575cb82020-01-29 13:15:09 +05302566 if (!chan->cyclic) {
2567 err = chan->stop_transfer(chan);
2568 if (err) {
2569 dev_err(chan->dev, "Cannot stop channel %p: %x\n",
2570 chan, dma_ctrl_read(chan,
2571 XILINX_DMA_REG_DMASR));
2572 chan->err = true;
2573 }
Akinobu Mita676f9c22017-03-14 00:59:11 +09002574 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302575
Radhey Shyam Pandey2575cb82020-01-29 13:15:09 +05302576 xilinx_dma_chan_reset(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302577 /* Remove and free all of the descriptors in the lists */
Adrian Larumbe7dd2dd4f2021-07-07 00:43:38 +01002578 chan->terminating = true;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302579 xilinx_dma_free_descriptors(chan);
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05302580 chan->idle = true;
Maxime Ripardba714042014-11-17 14:42:38 +01002581
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05302582 if (chan->cyclic) {
2583 reg = dma_ctrl_read(chan, XILINX_DMA_REG_DMACR);
2584 reg &= ~XILINX_DMA_CR_CYCLIC_BD_EN_MASK;
2585 dma_ctrl_write(chan, XILINX_DMA_REG_DMACR, reg);
2586 chan->cyclic = false;
2587 }
2588
Kedareswara rao Appana48c62fb2018-01-03 12:12:09 +05302589 if ((chan->xdev->dma_config->dmatype == XDMA_TYPE_CDMA) && chan->has_sg)
2590 dma_ctrl_clr(chan, XILINX_DMA_REG_DMACR,
2591 XILINX_CDMA_CR_SGMODE);
2592
Maxime Ripardba714042014-11-17 14:42:38 +01002593 return 0;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302594}
2595
Lars-Peter Clausen50db2052021-03-13 13:53:11 +01002596static void xilinx_dma_synchronize(struct dma_chan *dchan)
2597{
2598 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
2599
2600 tasklet_kill(&chan->tasklet);
2601}
2602
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302603/**
Shravya Kumbhamdbe3c542021-09-13 14:58:36 +05302604 * xilinx_vdma_channel_set_config - Configure VDMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302605 * Run-time configuration for Axi VDMA, supports:
2606 * . halt the channel
2607 * . configure interrupt coalescing and inter-packet delay threshold
2608 * . start/stop parking
2609 * . enable genlock
2610 *
2611 * @dchan: DMA channel
2612 * @cfg: VDMA device configuration pointer
2613 *
2614 * Return: '0' on success and failure value on error
2615 */
2616int xilinx_vdma_channel_set_config(struct dma_chan *dchan,
2617 struct xilinx_vdma_config *cfg)
2618{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302619 struct xilinx_dma_chan *chan = to_xilinx_chan(dchan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302620 u32 dmacr;
2621
2622 if (cfg->reset)
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302623 return xilinx_dma_chan_reset(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302624
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302625 dmacr = dma_ctrl_read(chan, XILINX_DMA_REG_DMACR);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302626
2627 chan->config.frm_dly = cfg->frm_dly;
2628 chan->config.park = cfg->park;
2629
2630 /* genlock settings */
2631 chan->config.gen_lock = cfg->gen_lock;
2632 chan->config.master = cfg->master;
2633
Radhey Shyam Pandey6c6de1d2019-09-26 16:20:58 +05302634 dmacr &= ~XILINX_DMA_DMACR_GENLOCK_EN;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302635 if (cfg->gen_lock && chan->genlock) {
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302636 dmacr |= XILINX_DMA_DMACR_GENLOCK_EN;
Radhey Shyam Pandey6c6de1d2019-09-26 16:20:58 +05302637 dmacr &= ~XILINX_DMA_DMACR_MASTER_MASK;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302638 dmacr |= cfg->master << XILINX_DMA_DMACR_MASTER_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302639 }
2640
2641 chan->config.frm_cnt_en = cfg->frm_cnt_en;
Radhey Shyam Pandey0894aa22018-06-13 13:04:48 +05302642 chan->config.vflip_en = cfg->vflip_en;
2643
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302644 if (cfg->park)
2645 chan->config.park_frm = cfg->park_frm;
2646 else
2647 chan->config.park_frm = -1;
2648
2649 chan->config.coalesc = cfg->coalesc;
2650 chan->config.delay = cfg->delay;
2651
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302652 if (cfg->coalesc <= XILINX_DMA_DMACR_FRAME_COUNT_MAX) {
Radhey Shyam Pandey6c6de1d2019-09-26 16:20:58 +05302653 dmacr &= ~XILINX_DMA_DMACR_FRAME_COUNT_MASK;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302654 dmacr |= cfg->coalesc << XILINX_DMA_DMACR_FRAME_COUNT_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302655 chan->config.coalesc = cfg->coalesc;
2656 }
2657
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302658 if (cfg->delay <= XILINX_DMA_DMACR_DELAY_MAX) {
Radhey Shyam Pandey6c6de1d2019-09-26 16:20:58 +05302659 dmacr &= ~XILINX_DMA_DMACR_DELAY_MASK;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302660 dmacr |= cfg->delay << XILINX_DMA_DMACR_DELAY_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302661 chan->config.delay = cfg->delay;
2662 }
2663
2664 /* FSync Source selection */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302665 dmacr &= ~XILINX_DMA_DMACR_FSYNCSRC_MASK;
2666 dmacr |= cfg->ext_fsync << XILINX_DMA_DMACR_FSYNCSRC_SHIFT;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302667
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302668 dma_ctrl_write(chan, XILINX_DMA_REG_DMACR, dmacr);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302669
2670 return 0;
2671}
2672EXPORT_SYMBOL(xilinx_vdma_channel_set_config);
2673
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302674/* -----------------------------------------------------------------------------
2675 * Probe and remove
2676 */
2677
2678/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302679 * xilinx_dma_chan_remove - Per Channel remove function
2680 * @chan: Driver specific DMA channel
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302681 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302682static void xilinx_dma_chan_remove(struct xilinx_dma_chan *chan)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302683{
2684 /* Disable all interrupts */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302685 dma_ctrl_clr(chan, XILINX_DMA_REG_DMACR,
2686 XILINX_DMA_DMAXR_ALL_IRQ_MASK);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302687
2688 if (chan->irq > 0)
2689 free_irq(chan->irq, chan);
2690
2691 tasklet_kill(&chan->tasklet);
2692
2693 list_del(&chan->common.device_node);
2694}
2695
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302696static int axidma_clk_init(struct platform_device *pdev, struct clk **axi_clk,
2697 struct clk **tx_clk, struct clk **rx_clk,
2698 struct clk **sg_clk, struct clk **tmp_clk)
2699{
2700 int err;
2701
2702 *tmp_clk = NULL;
2703
2704 *axi_clk = devm_clk_get(&pdev->dev, "s_axi_lite_aclk");
Krzysztof Kozlowskib0ef4892020-08-28 17:26:37 +02002705 if (IS_ERR(*axi_clk))
2706 return dev_err_probe(&pdev->dev, PTR_ERR(*axi_clk), "failed to get axi_aclk\n");
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302707
2708 *tx_clk = devm_clk_get(&pdev->dev, "m_axi_mm2s_aclk");
2709 if (IS_ERR(*tx_clk))
2710 *tx_clk = NULL;
2711
2712 *rx_clk = devm_clk_get(&pdev->dev, "m_axi_s2mm_aclk");
2713 if (IS_ERR(*rx_clk))
2714 *rx_clk = NULL;
2715
2716 *sg_clk = devm_clk_get(&pdev->dev, "m_axi_sg_aclk");
2717 if (IS_ERR(*sg_clk))
2718 *sg_clk = NULL;
2719
2720 err = clk_prepare_enable(*axi_clk);
2721 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002722 dev_err(&pdev->dev, "failed to enable axi_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302723 return err;
2724 }
2725
2726 err = clk_prepare_enable(*tx_clk);
2727 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002728 dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302729 goto err_disable_axiclk;
2730 }
2731
2732 err = clk_prepare_enable(*rx_clk);
2733 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002734 dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302735 goto err_disable_txclk;
2736 }
2737
2738 err = clk_prepare_enable(*sg_clk);
2739 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002740 dev_err(&pdev->dev, "failed to enable sg_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302741 goto err_disable_rxclk;
2742 }
2743
2744 return 0;
2745
2746err_disable_rxclk:
2747 clk_disable_unprepare(*rx_clk);
2748err_disable_txclk:
2749 clk_disable_unprepare(*tx_clk);
2750err_disable_axiclk:
2751 clk_disable_unprepare(*axi_clk);
2752
2753 return err;
2754}
2755
2756static int axicdma_clk_init(struct platform_device *pdev, struct clk **axi_clk,
2757 struct clk **dev_clk, struct clk **tmp_clk,
2758 struct clk **tmp1_clk, struct clk **tmp2_clk)
2759{
2760 int err;
2761
2762 *tmp_clk = NULL;
2763 *tmp1_clk = NULL;
2764 *tmp2_clk = NULL;
2765
2766 *axi_clk = devm_clk_get(&pdev->dev, "s_axi_lite_aclk");
Krzysztof Kozlowskib0ef4892020-08-28 17:26:37 +02002767 if (IS_ERR(*axi_clk))
2768 return dev_err_probe(&pdev->dev, PTR_ERR(*axi_clk), "failed to get axi_aclk\n");
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302769
2770 *dev_clk = devm_clk_get(&pdev->dev, "m_axi_aclk");
Krzysztof Kozlowskib0ef4892020-08-28 17:26:37 +02002771 if (IS_ERR(*dev_clk))
2772 return dev_err_probe(&pdev->dev, PTR_ERR(*dev_clk), "failed to get dev_clk\n");
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302773
2774 err = clk_prepare_enable(*axi_clk);
2775 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002776 dev_err(&pdev->dev, "failed to enable axi_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302777 return err;
2778 }
2779
2780 err = clk_prepare_enable(*dev_clk);
2781 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002782 dev_err(&pdev->dev, "failed to enable dev_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302783 goto err_disable_axiclk;
2784 }
2785
2786 return 0;
2787
2788err_disable_axiclk:
2789 clk_disable_unprepare(*axi_clk);
2790
2791 return err;
2792}
2793
2794static int axivdma_clk_init(struct platform_device *pdev, struct clk **axi_clk,
2795 struct clk **tx_clk, struct clk **txs_clk,
2796 struct clk **rx_clk, struct clk **rxs_clk)
2797{
2798 int err;
2799
2800 *axi_clk = devm_clk_get(&pdev->dev, "s_axi_lite_aclk");
Krzysztof Kozlowskib0ef4892020-08-28 17:26:37 +02002801 if (IS_ERR(*axi_clk))
2802 return dev_err_probe(&pdev->dev, PTR_ERR(*axi_clk), "failed to get axi_aclk\n");
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302803
2804 *tx_clk = devm_clk_get(&pdev->dev, "m_axi_mm2s_aclk");
2805 if (IS_ERR(*tx_clk))
2806 *tx_clk = NULL;
2807
2808 *txs_clk = devm_clk_get(&pdev->dev, "m_axis_mm2s_aclk");
2809 if (IS_ERR(*txs_clk))
2810 *txs_clk = NULL;
2811
2812 *rx_clk = devm_clk_get(&pdev->dev, "m_axi_s2mm_aclk");
2813 if (IS_ERR(*rx_clk))
2814 *rx_clk = NULL;
2815
2816 *rxs_clk = devm_clk_get(&pdev->dev, "s_axis_s2mm_aclk");
2817 if (IS_ERR(*rxs_clk))
2818 *rxs_clk = NULL;
2819
2820 err = clk_prepare_enable(*axi_clk);
2821 if (err) {
Radhey Shyam Pandey944879b2019-09-26 16:21:00 +05302822 dev_err(&pdev->dev, "failed to enable axi_clk (%d)\n",
2823 err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302824 return err;
2825 }
2826
2827 err = clk_prepare_enable(*tx_clk);
2828 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002829 dev_err(&pdev->dev, "failed to enable tx_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302830 goto err_disable_axiclk;
2831 }
2832
2833 err = clk_prepare_enable(*txs_clk);
2834 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002835 dev_err(&pdev->dev, "failed to enable txs_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302836 goto err_disable_txclk;
2837 }
2838
2839 err = clk_prepare_enable(*rx_clk);
2840 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002841 dev_err(&pdev->dev, "failed to enable rx_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302842 goto err_disable_txsclk;
2843 }
2844
2845 err = clk_prepare_enable(*rxs_clk);
2846 if (err) {
Lars-Peter Clausen574897d2017-08-31 13:35:10 +02002847 dev_err(&pdev->dev, "failed to enable rxs_clk (%d)\n", err);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05302848 goto err_disable_rxclk;
2849 }
2850
2851 return 0;
2852
2853err_disable_rxclk:
2854 clk_disable_unprepare(*rx_clk);
2855err_disable_txsclk:
2856 clk_disable_unprepare(*txs_clk);
2857err_disable_txclk:
2858 clk_disable_unprepare(*tx_clk);
2859err_disable_axiclk:
2860 clk_disable_unprepare(*axi_clk);
2861
2862 return err;
2863}
2864
2865static void xdma_disable_allclks(struct xilinx_dma_device *xdev)
2866{
2867 clk_disable_unprepare(xdev->rxs_clk);
2868 clk_disable_unprepare(xdev->rx_clk);
2869 clk_disable_unprepare(xdev->txs_clk);
2870 clk_disable_unprepare(xdev->tx_clk);
2871 clk_disable_unprepare(xdev->axi_clk);
2872}
2873
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302874/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302875 * xilinx_dma_chan_probe - Per Channel Probing
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302876 * It get channel features from the device tree entry and
2877 * initialize special channel handling routines
2878 *
2879 * @xdev: Driver specific device structure
2880 * @node: Device node
2881 *
2882 * Return: '0' on success and failure value on error
2883 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302884static int xilinx_dma_chan_probe(struct xilinx_dma_device *xdev,
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05302885 struct device_node *node)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302886{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302887 struct xilinx_dma_chan *chan;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302888 bool has_dre = false;
2889 u32 value, width;
2890 int err;
2891
2892 /* Allocate and initialize the channel structure */
2893 chan = devm_kzalloc(xdev->dev, sizeof(*chan), GFP_KERNEL);
2894 if (!chan)
2895 return -ENOMEM;
2896
2897 chan->dev = xdev->dev;
2898 chan->xdev = xdev;
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05302899 chan->desc_pendingcount = 0x0;
Kedareswara rao Appanab72db402016-04-06 10:38:08 +05302900 chan->ext_addr = xdev->ext_addr;
Vinod Koul30931862017-12-18 10:48:05 +05302901 /* This variable ensures that descriptors are not
2902 * Submitted when dma engine is in progress. This variable is
2903 * Added to avoid polling for a bit in the status register to
Kedareswara rao Appana21e02a32017-12-07 10:51:02 +05302904 * Know dma state in the driver hot path.
2905 */
2906 chan->idle = true;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302907
2908 spin_lock_init(&chan->lock);
2909 INIT_LIST_HEAD(&chan->pending_list);
2910 INIT_LIST_HEAD(&chan->done_list);
Kedareswara rao Appana7096f362016-02-26 19:33:51 +05302911 INIT_LIST_HEAD(&chan->active_list);
Kedareswara rao Appana23059402017-12-07 10:51:04 +05302912 INIT_LIST_HEAD(&chan->free_seg_list);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302913
2914 /* Retrieve the channel properties from the device tree */
2915 has_dre = of_property_read_bool(node, "xlnx,include-dre");
2916
2917 chan->genlock = of_property_read_bool(node, "xlnx,genlock-mode");
2918
2919 err = of_property_read_u32(node, "xlnx,datawidth", &value);
2920 if (err) {
2921 dev_err(xdev->dev, "missing xlnx,datawidth property\n");
2922 return err;
2923 }
2924 width = value >> 3; /* Convert bits to bytes */
2925
2926 /* If data width is greater than 8 bytes, DRE is not in hw */
2927 if (width > 8)
2928 has_dre = false;
2929
2930 if (!has_dre)
Shravya Kumbham2d5efea2020-12-23 16:51:02 +05302931 xdev->common.copy_align = (enum dmaengine_alignment)fls(width - 1);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302932
Kedareswara rao Appanae131f1b2016-06-24 10:51:26 +05302933 if (of_device_is_compatible(node, "xlnx,axi-vdma-mm2s-channel") ||
2934 of_device_is_compatible(node, "xlnx,axi-dma-mm2s-channel") ||
2935 of_device_is_compatible(node, "xlnx,axi-cdma-channel")) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302936 chan->direction = DMA_MEM_TO_DEV;
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05302937 chan->id = xdev->mm2s_chan_id++;
2938 chan->tdest = chan->id;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302939
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05302940 chan->ctrl_offset = XILINX_DMA_MM2S_CTRL_OFFSET;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05302941 if (xdev->dma_config->dmatype == XDMA_TYPE_VDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302942 chan->desc_offset = XILINX_VDMA_MM2S_DESC_OFFSET;
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +05302943 chan->config.park = 1;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302944
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302945 if (xdev->flush_on_fsync == XILINX_DMA_FLUSH_BOTH ||
2946 xdev->flush_on_fsync == XILINX_DMA_FLUSH_MM2S)
2947 chan->flush_on_fsync = true;
2948 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302949 } else if (of_device_is_compatible(node,
Kedareswara rao Appanae131f1b2016-06-24 10:51:26 +05302950 "xlnx,axi-vdma-s2mm-channel") ||
2951 of_device_is_compatible(node,
2952 "xlnx,axi-dma-s2mm-channel")) {
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302953 chan->direction = DMA_DEV_TO_MEM;
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05302954 chan->id = xdev->s2mm_chan_id++;
2955 chan->tdest = chan->id - xdev->dma_config->max_channels / 2;
Radhey Shyam Pandey0894aa22018-06-13 13:04:48 +05302956 chan->has_vflip = of_property_read_bool(node,
2957 "xlnx,enable-vert-flip");
2958 if (chan->has_vflip) {
2959 chan->config.vflip_en = dma_read(chan,
2960 XILINX_VDMA_REG_ENABLE_VERTICAL_FLIP) &
2961 XILINX_VDMA_ENABLE_VERTICAL_FLIP;
2962 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302963
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05302964 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA)
2965 chan->ctrl_offset = XILINX_MCDMA_S2MM_CTRL_OFFSET;
2966 else
2967 chan->ctrl_offset = XILINX_DMA_S2MM_CTRL_OFFSET;
2968
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05302969 if (xdev->dma_config->dmatype == XDMA_TYPE_VDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302970 chan->desc_offset = XILINX_VDMA_S2MM_DESC_OFFSET;
Kedareswara rao Appanafe0503e2017-12-07 10:51:03 +05302971 chan->config.park = 1;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302972
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302973 if (xdev->flush_on_fsync == XILINX_DMA_FLUSH_BOTH ||
2974 xdev->flush_on_fsync == XILINX_DMA_FLUSH_S2MM)
2975 chan->flush_on_fsync = true;
2976 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302977 } else {
2978 dev_err(xdev->dev, "Invalid channel compatible node\n");
2979 return -EINVAL;
2980 }
2981
2982 /* Request the interrupt */
Lars-Peter Clausenf17e5332021-12-08 12:42:12 +01002983 chan->irq = of_irq_get(node, chan->tdest);
2984 if (chan->irq < 0)
2985 return dev_err_probe(xdev->dev, chan->irq, "failed to get irq\n");
Radhey Shyam Pandeyc2f6b672019-10-22 22:30:21 +05302986 err = request_irq(chan->irq, xdev->dma_config->irq_handler,
2987 IRQF_SHARED, "xilinx-dma-controller", chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05302988 if (err) {
2989 dev_err(xdev->dev, "unable to request IRQ %d\n", chan->irq);
2990 return err;
2991 }
2992
Akinobu Mita676f9c22017-03-14 00:59:11 +09002993 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05302994 chan->start_transfer = xilinx_dma_start_transfer;
Akinobu Mita676f9c22017-03-14 00:59:11 +09002995 chan->stop_transfer = xilinx_dma_stop_transfer;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05302996 } else if (xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA) {
2997 chan->start_transfer = xilinx_mcdma_start_transfer;
2998 chan->stop_transfer = xilinx_dma_stop_transfer;
Akinobu Mita676f9c22017-03-14 00:59:11 +09002999 } else if (xdev->dma_config->dmatype == XDMA_TYPE_CDMA) {
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05303000 chan->start_transfer = xilinx_cdma_start_transfer;
Akinobu Mita676f9c22017-03-14 00:59:11 +09003001 chan->stop_transfer = xilinx_cdma_stop_transfer;
3002 } else {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303003 chan->start_transfer = xilinx_vdma_start_transfer;
Akinobu Mita676f9c22017-03-14 00:59:11 +09003004 chan->stop_transfer = xilinx_dma_stop_transfer;
3005 }
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303006
Matthew Murrian96d5d882020-11-04 12:30:06 +05303007 /* check if SG is enabled (only for AXIDMA, AXIMCDMA, and CDMA) */
Andrea Merello05f7ea72018-11-20 16:31:49 +01003008 if (xdev->dma_config->dmatype != XDMA_TYPE_VDMA) {
Matthew Murrian96d5d882020-11-04 12:30:06 +05303009 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA ||
3010 dma_ctrl_read(chan, XILINX_DMA_REG_DMASR) &
3011 XILINX_DMA_DMASR_SG_MASK)
Andrea Merello05f7ea72018-11-20 16:31:49 +01003012 chan->has_sg = true;
3013 dev_dbg(chan->dev, "ch %d: SG %s\n", chan->id,
3014 chan->has_sg ? "enabled" : "disabled");
3015 }
3016
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303017 /* Initialize the tasklet */
Allen Paisf19a11d2020-08-31 16:05:39 +05303018 tasklet_setup(&chan->tasklet, xilinx_dma_do_tasklet);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303019
3020 /*
3021 * Initialize the DMA channel and add it to the DMA engine channels
3022 * list.
3023 */
3024 chan->common.device = &xdev->common;
3025
3026 list_add_tail(&chan->common.device_node, &xdev->common.channels);
3027 xdev->chan[chan->id] = chan;
3028
3029 /* Reset the channel */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303030 err = xilinx_dma_chan_reset(chan);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303031 if (err < 0) {
3032 dev_err(xdev->dev, "Reset channel failed\n");
3033 return err;
3034 }
3035
3036 return 0;
3037}
3038
3039/**
Kedareswara rao Appana1a9e7a02016-06-24 10:51:23 +05303040 * xilinx_dma_child_probe - Per child node probe
3041 * It get number of dma-channels per child node from
3042 * device-tree and initializes all the channels.
3043 *
3044 * @xdev: Driver specific device structure
3045 * @node: Device node
3046 *
3047 * Return: 0 always.
3048 */
3049static int xilinx_dma_child_probe(struct xilinx_dma_device *xdev,
Kedareswara rao Appana22653af2017-12-07 10:51:06 +05303050 struct device_node *node)
3051{
Shravya Kumbhamfaeb0732020-12-23 16:51:01 +05303052 int ret, i;
3053 u32 nr_channels = 1;
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303054
3055 ret = of_property_read_u32(node, "dma-channels", &nr_channels);
3056 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA && ret < 0)
3057 dev_warn(xdev->dev, "missing dma-channels property\n");
Kedareswara rao Appana1a9e7a02016-06-24 10:51:23 +05303058
Lars-Peter Clausenf17e5332021-12-08 12:42:12 +01003059 for (i = 0; i < nr_channels; i++) {
3060 ret = xilinx_dma_chan_probe(xdev, node);
3061 if (ret)
3062 return ret;
3063 }
Kedareswara rao Appana1a9e7a02016-06-24 10:51:23 +05303064
3065 return 0;
3066}
3067
3068/**
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303069 * of_dma_xilinx_xlate - Translation function
3070 * @dma_spec: Pointer to DMA specifier as found in the device tree
3071 * @ofdma: Pointer to DMA controller data
3072 *
3073 * Return: DMA channel pointer on success and NULL on error
3074 */
3075static struct dma_chan *of_dma_xilinx_xlate(struct of_phandle_args *dma_spec,
3076 struct of_dma *ofdma)
3077{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303078 struct xilinx_dma_device *xdev = ofdma->of_dma_data;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303079 int chan_id = dma_spec->args[0];
3080
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05303081 if (chan_id >= xdev->dma_config->max_channels || !xdev->chan[chan_id])
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303082 return NULL;
3083
3084 return dma_get_slave_channel(&xdev->chan[chan_id]->common);
3085}
3086
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303087static const struct xilinx_dma_config axidma_config = {
3088 .dmatype = XDMA_TYPE_AXIDMA,
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303089 .clk_init = axidma_clk_init,
Radhey Shyam Pandeyc2f6b672019-10-22 22:30:21 +05303090 .irq_handler = xilinx_dma_irq_handler,
Radhey Shyam Pandey04c2bc22020-01-30 18:24:24 +05303091 .max_channels = XILINX_DMA_MAX_CHANS_PER_DEVICE,
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303092};
3093
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303094static const struct xilinx_dma_config aximcdma_config = {
3095 .dmatype = XDMA_TYPE_AXIMCDMA,
3096 .clk_init = axidma_clk_init,
3097 .irq_handler = xilinx_mcdma_irq_handler,
Radhey Shyam Pandey04c2bc22020-01-30 18:24:24 +05303098 .max_channels = XILINX_MCDMA_MAX_CHANS_PER_DEVICE,
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303099};
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303100static const struct xilinx_dma_config axicdma_config = {
3101 .dmatype = XDMA_TYPE_CDMA,
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303102 .clk_init = axicdma_clk_init,
Radhey Shyam Pandeyc2f6b672019-10-22 22:30:21 +05303103 .irq_handler = xilinx_dma_irq_handler,
Radhey Shyam Pandey04c2bc22020-01-30 18:24:24 +05303104 .max_channels = XILINX_CDMA_MAX_CHANS_PER_DEVICE,
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303105};
3106
3107static const struct xilinx_dma_config axivdma_config = {
3108 .dmatype = XDMA_TYPE_VDMA,
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303109 .clk_init = axivdma_clk_init,
Radhey Shyam Pandeyc2f6b672019-10-22 22:30:21 +05303110 .irq_handler = xilinx_dma_irq_handler,
Radhey Shyam Pandey04c2bc22020-01-30 18:24:24 +05303111 .max_channels = XILINX_DMA_MAX_CHANS_PER_DEVICE,
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303112};
3113
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303114static const struct of_device_id xilinx_dma_of_ids[] = {
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303115 { .compatible = "xlnx,axi-dma-1.00.a", .data = &axidma_config },
3116 { .compatible = "xlnx,axi-cdma-1.00.a", .data = &axicdma_config },
3117 { .compatible = "xlnx,axi-vdma-1.00.a", .data = &axivdma_config },
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303118 { .compatible = "xlnx,axi-mcdma-1.00.a", .data = &aximcdma_config },
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303119 {}
3120};
3121MODULE_DEVICE_TABLE(of, xilinx_dma_of_ids);
3122
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303123/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303124 * xilinx_dma_probe - Driver probe function
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303125 * @pdev: Pointer to the platform_device structure
3126 *
3127 * Return: '0' on success and failure value on error
3128 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303129static int xilinx_dma_probe(struct platform_device *pdev)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303130{
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303131 int (*clk_init)(struct platform_device *, struct clk **, struct clk **,
3132 struct clk **, struct clk **, struct clk **)
3133 = axivdma_clk_init;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303134 struct device_node *node = pdev->dev.of_node;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303135 struct xilinx_dma_device *xdev;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303136 struct device_node *child, *np = pdev->dev.of_node;
Radhey Shyam Pandeyae809692018-11-20 16:31:48 +01003137 u32 num_frames, addr_width, len_width;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303138 int i, err;
3139
3140 /* Allocate and initialize the DMA engine structure */
3141 xdev = devm_kzalloc(&pdev->dev, sizeof(*xdev), GFP_KERNEL);
3142 if (!xdev)
3143 return -ENOMEM;
3144
3145 xdev->dev = &pdev->dev;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303146 if (np) {
3147 const struct of_device_id *match;
3148
3149 match = of_match_node(xilinx_dma_of_ids, np);
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303150 if (match && match->data) {
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303151 xdev->dma_config = match->data;
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303152 clk_init = xdev->dma_config->clk_init;
3153 }
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303154 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303155
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303156 err = clk_init(pdev, &xdev->axi_clk, &xdev->tx_clk, &xdev->txs_clk,
3157 &xdev->rx_clk, &xdev->rxs_clk);
3158 if (err)
3159 return err;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303160
3161 /* Request and map I/O memory */
Radhey Shyam Pandeya8bd4752019-09-26 16:20:59 +05303162 xdev->regs = devm_platform_ioremap_resource(pdev, 0);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303163 if (IS_ERR(xdev->regs))
3164 return PTR_ERR(xdev->regs);
3165
3166 /* Retrieve the DMA engine properties from the device tree */
Radhey Shyam Pandeyae809692018-11-20 16:31:48 +01003167 xdev->max_buffer_len = GENMASK(XILINX_DMA_MAX_TRANS_LEN_MAX - 1, 0);
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05303168 xdev->s2mm_chan_id = xdev->dma_config->max_channels / 2;
Andrea Merello616f0f82018-11-20 16:31:45 +01003169
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303170 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA ||
3171 xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA) {
Radhey Shyam Pandeyae809692018-11-20 16:31:48 +01003172 if (!of_property_read_u32(node, "xlnx,sg-length-width",
3173 &len_width)) {
3174 if (len_width < XILINX_DMA_MAX_TRANS_LEN_MIN ||
3175 len_width > XILINX_DMA_V2_MAX_TRANS_LEN_MAX) {
3176 dev_warn(xdev->dev,
3177 "invalid xlnx,sg-length-width property value. Using default width\n");
3178 } else {
3179 if (len_width > XILINX_DMA_MAX_TRANS_LEN_MAX)
3180 dev_warn(xdev->dev, "Please ensure that IP supports buffer length > 23 bits\n");
3181 xdev->max_buffer_len =
3182 GENMASK(len_width - 1, 0);
3183 }
3184 }
3185 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303186
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303187 if (xdev->dma_config->dmatype == XDMA_TYPE_VDMA) {
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303188 err = of_property_read_u32(node, "xlnx,num-fstores",
3189 &num_frames);
3190 if (err < 0) {
3191 dev_err(xdev->dev,
3192 "missing xlnx,num-fstores property\n");
3193 return err;
3194 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303195
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303196 err = of_property_read_u32(node, "xlnx,flush-fsync",
3197 &xdev->flush_on_fsync);
3198 if (err < 0)
3199 dev_warn(xdev->dev,
3200 "missing xlnx,flush-fsync property\n");
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303201 }
3202
Kedareswara rao Appanab72db402016-04-06 10:38:08 +05303203 err = of_property_read_u32(node, "xlnx,addrwidth", &addr_width);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303204 if (err < 0)
Kedareswara rao Appanab72db402016-04-06 10:38:08 +05303205 dev_warn(xdev->dev, "missing xlnx,addrwidth property\n");
3206
3207 if (addr_width > 32)
3208 xdev->ext_addr = true;
3209 else
3210 xdev->ext_addr = false;
3211
3212 /* Set the dma mask bits */
Radhey Shyam Pandeyaac6c0f2021-08-19 14:28:48 +05303213 dma_set_mask_and_coherent(xdev->dev, DMA_BIT_MASK(addr_width));
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303214
3215 /* Initialize the DMA engine */
3216 xdev->common.dev = &pdev->dev;
3217
3218 INIT_LIST_HEAD(&xdev->common.channels);
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303219 if (!(xdev->dma_config->dmatype == XDMA_TYPE_CDMA)) {
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05303220 dma_cap_set(DMA_SLAVE, xdev->common.cap_mask);
3221 dma_cap_set(DMA_PRIVATE, xdev->common.cap_mask);
3222 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303223
3224 xdev->common.device_alloc_chan_resources =
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303225 xilinx_dma_alloc_chan_resources;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303226 xdev->common.device_free_chan_resources =
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303227 xilinx_dma_free_chan_resources;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303228 xdev->common.device_terminate_all = xilinx_dma_terminate_all;
Lars-Peter Clausen50db2052021-03-13 13:53:11 +01003229 xdev->common.device_synchronize = xilinx_dma_synchronize;
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303230 xdev->common.device_tx_status = xilinx_dma_tx_status;
3231 xdev->common.device_issue_pending = xilinx_dma_issue_pending;
Marek Vasut4153a7f2021-08-04 21:51:40 +02003232 xdev->common.device_config = xilinx_dma_device_config;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303233 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA) {
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05303234 dma_cap_set(DMA_CYCLIC, xdev->common.cap_mask);
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303235 xdev->common.device_prep_slave_sg = xilinx_dma_prep_slave_sg;
Kedareswara rao Appana92d794d2016-05-18 13:17:30 +05303236 xdev->common.device_prep_dma_cyclic =
3237 xilinx_dma_prep_dma_cyclic;
Nicholas Graumanna575d0b2019-10-15 20:18:21 +05303238 /* Residue calculation is supported by only AXI DMA and CDMA */
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303239 xdev->common.residue_granularity =
3240 DMA_RESIDUE_GRANULARITY_SEGMENT;
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303241 } else if (xdev->dma_config->dmatype == XDMA_TYPE_CDMA) {
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05303242 dma_cap_set(DMA_MEMCPY, xdev->common.cap_mask);
Adrian Larumbe29cf37f2021-11-01 18:08:25 +00003243 dma_cap_set(DMA_MEMCPY_SG, xdev->common.cap_mask);
Kedareswara rao Appana07b0e7d2016-04-07 10:59:45 +05303244 xdev->common.device_prep_dma_memcpy = xilinx_cdma_prep_memcpy;
Adrian Larumbe29cf37f2021-11-01 18:08:25 +00003245 xdev->common.device_prep_dma_memcpy_sg = xilinx_cdma_prep_memcpy_sg;
Nicholas Graumanna575d0b2019-10-15 20:18:21 +05303246 /* Residue calculation is supported by only AXI DMA and CDMA */
3247 xdev->common.residue_granularity =
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303248 DMA_RESIDUE_GRANULARITY_SEGMENT;
3249 } else if (xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA) {
3250 xdev->common.device_prep_slave_sg = xilinx_mcdma_prep_slave_sg;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303251 } else {
3252 xdev->common.device_prep_interleaved_dma =
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303253 xilinx_vdma_dma_prep_interleaved;
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303254 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303255
3256 platform_set_drvdata(pdev, xdev);
3257
3258 /* Initialize the channels */
3259 for_each_child_of_node(node, child) {
Kedareswara rao Appana1a9e7a02016-06-24 10:51:23 +05303260 err = xilinx_dma_child_probe(xdev, child);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303261 if (err < 0)
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303262 goto disable_clks;
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303263 }
3264
Kedareswara rao Appanafb236662016-05-13 12:33:29 +05303265 if (xdev->dma_config->dmatype == XDMA_TYPE_VDMA) {
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05303266 for (i = 0; i < xdev->dma_config->max_channels; i++)
Kedareswara rao Appanac0bba3a2016-04-07 10:59:43 +05303267 if (xdev->chan[i])
3268 xdev->chan[i]->num_frms = num_frames;
3269 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303270
3271 /* Register the DMA engine with the core */
Shravya Kumbham99974ae2020-12-23 16:51:00 +05303272 err = dma_async_device_register(&xdev->common);
3273 if (err) {
3274 dev_err(xdev->dev, "failed to register the dma device\n");
3275 goto error;
3276 }
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303277
3278 err = of_dma_controller_register(node, of_dma_xilinx_xlate,
3279 xdev);
3280 if (err < 0) {
3281 dev_err(&pdev->dev, "Unable to register DMA to DT\n");
3282 dma_async_device_unregister(&xdev->common);
3283 goto error;
3284 }
3285
Kedareswara rao Appanac7a03592017-12-07 10:51:07 +05303286 if (xdev->dma_config->dmatype == XDMA_TYPE_AXIDMA)
3287 dev_info(&pdev->dev, "Xilinx AXI DMA Engine Driver Probed!!\n");
3288 else if (xdev->dma_config->dmatype == XDMA_TYPE_CDMA)
3289 dev_info(&pdev->dev, "Xilinx AXI CDMA Engine Driver Probed!!\n");
Radhey Shyam Pandey6ccd6922019-10-22 22:30:22 +05303290 else if (xdev->dma_config->dmatype == XDMA_TYPE_AXIMCDMA)
3291 dev_info(&pdev->dev, "Xilinx AXI MCDMA Engine Driver Probed!!\n");
Kedareswara rao Appanac7a03592017-12-07 10:51:07 +05303292 else
3293 dev_info(&pdev->dev, "Xilinx AXI VDMA Engine Driver Probed!!\n");
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303294
3295 return 0;
3296
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303297disable_clks:
3298 xdma_disable_allclks(xdev);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303299error:
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05303300 for (i = 0; i < xdev->dma_config->max_channels; i++)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303301 if (xdev->chan[i])
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303302 xilinx_dma_chan_remove(xdev->chan[i]);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303303
3304 return err;
3305}
3306
3307/**
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303308 * xilinx_dma_remove - Driver remove function
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303309 * @pdev: Pointer to the platform_device structure
3310 *
3311 * Return: Always '0'
3312 */
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303313static int xilinx_dma_remove(struct platform_device *pdev)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303314{
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303315 struct xilinx_dma_device *xdev = platform_get_drvdata(pdev);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303316 int i;
3317
3318 of_dma_controller_free(pdev->dev.of_node);
3319
3320 dma_async_device_unregister(&xdev->common);
3321
Radhey Shyam Pandey14ccf0a2020-01-30 18:24:25 +05303322 for (i = 0; i < xdev->dma_config->max_channels; i++)
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303323 if (xdev->chan[i])
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303324 xilinx_dma_chan_remove(xdev->chan[i]);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303325
Kedareswara rao Appanaba16db32016-05-13 12:33:31 +05303326 xdma_disable_allclks(xdev);
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303327
3328 return 0;
3329}
3330
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303331static struct platform_driver xilinx_vdma_driver = {
3332 .driver = {
3333 .name = "xilinx-vdma",
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303334 .of_match_table = xilinx_dma_of_ids,
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303335 },
Kedareswara rao Appana42c1a2e2016-04-07 10:59:41 +05303336 .probe = xilinx_dma_probe,
3337 .remove = xilinx_dma_remove,
Srikanth Thokala9cd43602014-04-23 20:23:26 +05303338};
3339
3340module_platform_driver(xilinx_vdma_driver);
3341
3342MODULE_AUTHOR("Xilinx, Inc.");
3343MODULE_DESCRIPTION("Xilinx VDMA driver");
3344MODULE_LICENSE("GPL v2");