sun6i_dma.c revision 1.16 1 1.16 skrll /* $NetBSD: sun6i_dma.c,v 1.16 2024/08/13 07:20:23 skrll Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2014-2017 Jared McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jmcneill * SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.2 jmcneill #include "opt_ddb.h"
30 1.2 jmcneill
31 1.1 jmcneill #include <sys/cdefs.h>
32 1.16 skrll __KERNEL_RCSID(0, "$NetBSD: sun6i_dma.c,v 1.16 2024/08/13 07:20:23 skrll Exp $");
33 1.1 jmcneill
34 1.1 jmcneill #include <sys/param.h>
35 1.1 jmcneill #include <sys/bus.h>
36 1.1 jmcneill #include <sys/device.h>
37 1.1 jmcneill #include <sys/intr.h>
38 1.1 jmcneill #include <sys/systm.h>
39 1.1 jmcneill #include <sys/mutex.h>
40 1.1 jmcneill #include <sys/bitops.h>
41 1.1 jmcneill #include <sys/kmem.h>
42 1.1 jmcneill
43 1.1 jmcneill #include <dev/fdt/fdtvar.h>
44 1.1 jmcneill
45 1.1 jmcneill #define DMA_IRQ_EN_REG0_REG 0x0000
46 1.1 jmcneill #define DMA_IRQ_EN_REG1_REG 0x0004
47 1.1 jmcneill #define DMA_IRQ_EN_REG0_QUEUE_IRQ_EN(n) __BIT(n * 4 + 2)
48 1.1 jmcneill #define DMA_IRQ_EN_REG0_PKG_IRQ_EN(n) __BIT(n * 4 + 1)
49 1.1 jmcneill #define DMA_IRQ_EN_REG0_HLAF_IRQ_EN(n) __BIT(n * 4 + 0)
50 1.1 jmcneill #define DMA_IRQ_EN_REG1_QUEUE_IRQ_EN(n) __BIT((n - 8) * 4 + 2)
51 1.1 jmcneill #define DMA_IRQ_EN_REG1_PKG_IRQ_EN(n) __BIT((n - 8) * 4 + 1)
52 1.1 jmcneill #define DMA_IRQ_EN_REG1_HLAF_IRQ_EN(n) __BIT((n - 8) * 4 + 0)
53 1.1 jmcneill #define DMA_IRQ_PEND_REG0_REG 0x0010
54 1.1 jmcneill #define DMA_IRQ_PEND_REG1_REG 0x0014
55 1.1 jmcneill #define DMA_IRQ_QUEUE_MASK 0x4444444444444444ULL
56 1.1 jmcneill #define DMA_IRQ_PKG_MASK 0x2222222222222222ULL
57 1.1 jmcneill #define DMA_IRQ_HF_MASK 0x1111111111111111ULL
58 1.1 jmcneill #define DMA_STA_REG 0x0030
59 1.1 jmcneill #define DMA_EN_REG(n) (0x0100 + (n) * 0x40 + 0x00)
60 1.1 jmcneill #define DMA_EN_EN __BIT(0)
61 1.1 jmcneill #define DMA_PAU_REG(n) (0x0100 + (n) * 0x40 + 0x04)
62 1.1 jmcneill #define DMA_PAU_PAUSE __BIT(0)
63 1.1 jmcneill #define DMA_START_ADDR_REG(n) (0x0100 + (n) * 0x40 + 0x08)
64 1.1 jmcneill #define DMA_CFG_REG(n) (0x0100 + (n) * 0x40 + 0x0C)
65 1.1 jmcneill #define DMA_CFG_DEST_DATA_WIDTH __BITS(26,25)
66 1.1 jmcneill #define DMA_CFG_DATA_WIDTH(n) ((n) >> 4)
67 1.1 jmcneill #define DMA_CFG_BST_LEN(n) ((n) == 1 ? 0 : (((n) >> 3) + 1))
68 1.1 jmcneill #define DMA_CFG_DEST_ADDR_MODE __BITS(22,21)
69 1.1 jmcneill #define DMA_CFG_ADDR_MODE_LINEAR 0
70 1.1 jmcneill #define DMA_CFG_ADDR_MODE_IO 1
71 1.1 jmcneill #define DMA_CFG_DEST_DRQ_TYPE __BITS(20,16)
72 1.1 jmcneill #define DMA_CFG_DRQ_TYPE_SDRAM 1
73 1.1 jmcneill #define DMA_CFG_SRC_DATA_WIDTH __BITS(10,9)
74 1.1 jmcneill #define DMA_CFG_SRC_ADDR_MODE __BITS(6,5)
75 1.1 jmcneill #define DMA_CFG_SRC_DRQ_TYPE __BITS(4,0)
76 1.1 jmcneill #define DMA_CUR_SRC_REG(n) (0x0100 + (n) * 0x40 + 0x10)
77 1.1 jmcneill #define DMA_CUR_DEST_REG(n) (0x0100 + (n) * 0x40 + 0x14)
78 1.1 jmcneill #define DMA_BCNT_LEFT_REG(n) (0x0100 + (n) * 0x40 + 0x18)
79 1.1 jmcneill #define DMA_PARA_REG(n) (0x0100 + (n) * 0x40 + 0x1C)
80 1.1 jmcneill #define DMA_PARA_DATA_BLK_SIZE __BITS(15,8)
81 1.1 jmcneill #define DMA_PARA_WAIT_CYC __BITS(7,0)
82 1.8 jakllsch #define DMA_MODE_REG(n) (0x0100 + (n) * 0x40 + 0x28)
83 1.8 jakllsch #define MODE_WAIT 0b0
84 1.8 jakllsch #define MODE_HANDSHAKE 0b1
85 1.8 jakllsch #define DMA_MODE_DST(m) __SHIFTIN((m), __BIT(3))
86 1.8 jakllsch #define DMA_MODE_SRC(m) __SHIFTIN((m), __BIT(2))
87 1.8 jakllsch #define DMA_FDESC_ADDR_REG(n) (0x0100 + (n) * 0x40 + 0x2C)
88 1.8 jakllsch #define DMA_PKG_NUM_REG(n) (0x0100 + (n) * 0x40 + 0x30)
89 1.1 jmcneill
90 1.1 jmcneill struct sun6idma_desc {
91 1.1 jmcneill uint32_t dma_config;
92 1.1 jmcneill uint32_t dma_srcaddr;
93 1.1 jmcneill uint32_t dma_dstaddr;
94 1.1 jmcneill uint32_t dma_bcnt;
95 1.1 jmcneill uint32_t dma_para;
96 1.1 jmcneill uint32_t dma_next;
97 1.1 jmcneill #define DMA_NULL 0xfffff800
98 1.1 jmcneill };
99 1.1 jmcneill
100 1.4 jmcneill struct sun6idma_config {
101 1.4 jmcneill u_int num_channels;
102 1.4 jmcneill bool autogate;
103 1.8 jakllsch uint8_t bursts;
104 1.8 jakllsch uint8_t widths;
105 1.4 jmcneill bus_size_t autogate_reg;
106 1.4 jmcneill uint32_t autogate_mask;
107 1.6 jmcneill uint32_t burst_mask;
108 1.4 jmcneill };
109 1.4 jmcneill
110 1.8 jakllsch #define IL2B(x) __BIT(ilog2(x))
111 1.8 jakllsch #define IL2B_RANGE(x, y) __BITS(ilog2(x), ilog2(y))
112 1.8 jakllsch #define WIDTHS_1_2_4 IL2B_RANGE(4, 1)
113 1.8 jakllsch #define WIDTHS_1_2_4_8 IL2B_RANGE(8, 1)
114 1.8 jakllsch #define BURSTS_1_8 (IL2B(8)|IL2B(1))
115 1.8 jakllsch #define BURSTS_1_4_8_16 (IL2B(16)|IL2B(8)|IL2B(4)|IL2B(1))
116 1.8 jakllsch
117 1.4 jmcneill static const struct sun6idma_config sun6i_a31_dma_config = {
118 1.6 jmcneill .num_channels = 16,
119 1.6 jmcneill .burst_mask = __BITS(8,7),
120 1.8 jakllsch .bursts = BURSTS_1_8,
121 1.8 jakllsch .widths = WIDTHS_1_2_4,
122 1.4 jmcneill };
123 1.4 jmcneill
124 1.4 jmcneill static const struct sun6idma_config sun8i_a83t_dma_config = {
125 1.4 jmcneill .num_channels = 8,
126 1.4 jmcneill .autogate = true,
127 1.4 jmcneill .autogate_reg = 0x20,
128 1.4 jmcneill .autogate_mask = 0x4,
129 1.6 jmcneill .burst_mask = __BITS(8,7),
130 1.8 jakllsch .bursts = BURSTS_1_8,
131 1.8 jakllsch .widths = WIDTHS_1_2_4,
132 1.4 jmcneill };
133 1.4 jmcneill
134 1.4 jmcneill static const struct sun6idma_config sun8i_h3_dma_config = {
135 1.4 jmcneill .num_channels = 12,
136 1.4 jmcneill .autogate = true,
137 1.4 jmcneill .autogate_reg = 0x28,
138 1.4 jmcneill .autogate_mask = 0x4,
139 1.6 jmcneill .burst_mask = __BITS(7,6),
140 1.8 jakllsch .bursts = BURSTS_1_4_8_16,
141 1.8 jakllsch .widths = WIDTHS_1_2_4_8,
142 1.4 jmcneill };
143 1.4 jmcneill
144 1.15 jmcneill static const struct sun6idma_config sun8i_v3s_dma_config = {
145 1.15 jmcneill .num_channels = 8,
146 1.15 jmcneill .autogate = true,
147 1.15 jmcneill .autogate_reg = 0x20,
148 1.15 jmcneill .autogate_mask = 0x4,
149 1.15 jmcneill .burst_mask = __BITS(8,7),
150 1.15 jmcneill .bursts = BURSTS_1_8,
151 1.15 jmcneill .widths = WIDTHS_1_2_4,
152 1.15 jmcneill };
153 1.15 jmcneill
154 1.16 skrll static const struct sun6idma_config sun20i_d1_dma_config = {
155 1.16 skrll .num_channels = 16,
156 1.16 skrll .autogate = true,
157 1.16 skrll .autogate_reg = 0x28,
158 1.16 skrll .autogate_mask = 0x4,
159 1.16 skrll .burst_mask = __BITS(7,6),
160 1.16 skrll .bursts = BURSTS_1_4_8_16,
161 1.16 skrll .widths = WIDTHS_1_2_4_8,
162 1.16 skrll };
163 1.16 skrll
164 1.4 jmcneill static const struct sun6idma_config sun50i_a64_dma_config = {
165 1.4 jmcneill .num_channels = 8,
166 1.4 jmcneill .autogate = true,
167 1.4 jmcneill .autogate_reg = 0x28,
168 1.4 jmcneill .autogate_mask = 0x4,
169 1.6 jmcneill .burst_mask = __BITS(7,6),
170 1.8 jakllsch .bursts = BURSTS_1_4_8_16,
171 1.8 jakllsch .widths = WIDTHS_1_2_4_8,
172 1.4 jmcneill };
173 1.4 jmcneill
174 1.11 thorpej static const struct device_compatible_entry compat_data[] = {
175 1.11 thorpej { .compat = "allwinner,sun6i-a31-dma",
176 1.11 thorpej .data = &sun6i_a31_dma_config },
177 1.11 thorpej { .compat = "allwinner,sun8i-a83t-dma",
178 1.11 thorpej .data = &sun8i_a83t_dma_config },
179 1.11 thorpej { .compat = "allwinner,sun8i-h3-dma",
180 1.11 thorpej .data = &sun8i_h3_dma_config },
181 1.15 jmcneill { .compat = "allwinner,sun8i-v3s-dma",
182 1.15 jmcneill .data = &sun8i_v3s_dma_config },
183 1.16 skrll { .compat = "allwinner,sun20i-d1-dma",
184 1.16 skrll .data = &sun20i_d1_dma_config },
185 1.11 thorpej { .compat = "allwinner,sun50i-a64-dma",
186 1.11 thorpej .data = &sun50i_a64_dma_config },
187 1.11 thorpej
188 1.13 thorpej DEVICE_COMPAT_EOL
189 1.1 jmcneill };
190 1.1 jmcneill
191 1.1 jmcneill struct sun6idma_channel {
192 1.1 jmcneill uint8_t ch_index;
193 1.1 jmcneill void (*ch_callback)(void *);
194 1.1 jmcneill void *ch_callbackarg;
195 1.1 jmcneill u_int ch_portid;
196 1.1 jmcneill void *ch_dmadesc;
197 1.1 jmcneill };
198 1.1 jmcneill
199 1.1 jmcneill struct sun6idma_softc {
200 1.1 jmcneill device_t sc_dev;
201 1.1 jmcneill bus_space_tag_t sc_bst;
202 1.1 jmcneill bus_space_handle_t sc_bsh;
203 1.1 jmcneill bus_dma_tag_t sc_dmat;
204 1.1 jmcneill int sc_phandle;
205 1.1 jmcneill void *sc_ih;
206 1.1 jmcneill
207 1.6 jmcneill uint32_t sc_burst_mask;
208 1.6 jmcneill
209 1.1 jmcneill kmutex_t sc_lock;
210 1.1 jmcneill
211 1.1 jmcneill struct sun6idma_channel *sc_chan;
212 1.1 jmcneill u_int sc_nchan;
213 1.7 jakllsch u_int sc_ndesc_ch;
214 1.8 jakllsch uint8_t sc_widths;
215 1.8 jakllsch uint8_t sc_bursts;
216 1.7 jakllsch
217 1.7 jakllsch bus_dma_segment_t sc_dmasegs[1];
218 1.7 jakllsch bus_dmamap_t sc_dmamap;
219 1.7 jakllsch void *sc_dmadescs;
220 1.1 jmcneill };
221 1.1 jmcneill
222 1.1 jmcneill #define DMA_READ(sc, reg) \
223 1.1 jmcneill bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
224 1.1 jmcneill #define DMA_WRITE(sc, reg, val) \
225 1.1 jmcneill bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
226 1.1 jmcneill
227 1.7 jakllsch #define DESC_NUM ((MAXPHYS / MIN_PAGE_SIZE + 1) + 1)
228 1.7 jakllsch #define DESC_LEN(n) \
229 1.7 jakllsch (sizeof(struct sun6idma_desc) * (n))
230 1.7 jakllsch #define DESC_OFFS(ch, n) \
231 1.7 jakllsch ((ch) * roundup2(DESC_LEN(DESC_NUM), COHERENCY_UNIT) + DESC_LEN(n))
232 1.7 jakllsch #define DESC_ADDR(sc, chp, n) \
233 1.7 jakllsch ((sc)->sc_dmamap->dm_segs[0].ds_addr + DESC_OFFS((chp)->ch_index, (n)))
234 1.7 jakllsch
235 1.1 jmcneill static void *
236 1.1 jmcneill sun6idma_acquire(device_t dev, const void *data, size_t len,
237 1.1 jmcneill void (*cb)(void *), void *cbarg)
238 1.1 jmcneill {
239 1.1 jmcneill struct sun6idma_softc *sc = device_private(dev);
240 1.1 jmcneill struct sun6idma_channel *ch = NULL;
241 1.1 jmcneill uint32_t irqen;
242 1.1 jmcneill uint8_t index;
243 1.1 jmcneill
244 1.1 jmcneill if (len != 4)
245 1.1 jmcneill return NULL;
246 1.1 jmcneill
247 1.1 jmcneill const u_int portid = be32dec(data);
248 1.1 jmcneill if (portid > __SHIFTOUT_MASK(DMA_CFG_SRC_DRQ_TYPE))
249 1.1 jmcneill return NULL;
250 1.1 jmcneill
251 1.1 jmcneill mutex_enter(&sc->sc_lock);
252 1.1 jmcneill
253 1.1 jmcneill for (index = 0; index < sc->sc_nchan; index++) {
254 1.1 jmcneill if (sc->sc_chan[index].ch_callback == NULL) {
255 1.1 jmcneill ch = &sc->sc_chan[index];
256 1.1 jmcneill ch->ch_callback = cb;
257 1.1 jmcneill ch->ch_callbackarg = cbarg;
258 1.1 jmcneill ch->ch_portid = portid;
259 1.1 jmcneill
260 1.1 jmcneill irqen = DMA_READ(sc, index < 8 ?
261 1.1 jmcneill DMA_IRQ_EN_REG0_REG :
262 1.1 jmcneill DMA_IRQ_EN_REG1_REG);
263 1.1 jmcneill irqen |= (index < 8 ?
264 1.1 jmcneill DMA_IRQ_EN_REG0_PKG_IRQ_EN(index) :
265 1.1 jmcneill DMA_IRQ_EN_REG1_PKG_IRQ_EN(index));
266 1.1 jmcneill DMA_WRITE(sc, index < 8 ?
267 1.1 jmcneill DMA_IRQ_EN_REG0_REG :
268 1.1 jmcneill DMA_IRQ_EN_REG1_REG, irqen);
269 1.1 jmcneill
270 1.1 jmcneill break;
271 1.1 jmcneill }
272 1.1 jmcneill }
273 1.1 jmcneill
274 1.1 jmcneill mutex_exit(&sc->sc_lock);
275 1.1 jmcneill
276 1.1 jmcneill return ch;
277 1.1 jmcneill }
278 1.1 jmcneill
279 1.1 jmcneill static void
280 1.1 jmcneill sun6idma_release(device_t dev, void *priv)
281 1.1 jmcneill {
282 1.1 jmcneill struct sun6idma_softc *sc = device_private(dev);
283 1.1 jmcneill struct sun6idma_channel *ch = priv;
284 1.1 jmcneill uint32_t irqen;
285 1.1 jmcneill uint8_t index = ch->ch_index;
286 1.1 jmcneill
287 1.1 jmcneill mutex_enter(&sc->sc_lock);
288 1.1 jmcneill
289 1.1 jmcneill irqen = DMA_READ(sc, index < 8 ?
290 1.1 jmcneill DMA_IRQ_EN_REG0_REG :
291 1.1 jmcneill DMA_IRQ_EN_REG1_REG);
292 1.1 jmcneill irqen &= ~(index < 8 ?
293 1.1 jmcneill DMA_IRQ_EN_REG0_PKG_IRQ_EN(index) :
294 1.1 jmcneill DMA_IRQ_EN_REG1_PKG_IRQ_EN(index));
295 1.1 jmcneill DMA_WRITE(sc, index < 8 ?
296 1.1 jmcneill DMA_IRQ_EN_REG0_REG :
297 1.1 jmcneill DMA_IRQ_EN_REG1_REG, irqen);
298 1.1 jmcneill
299 1.1 jmcneill ch->ch_callback = NULL;
300 1.1 jmcneill ch->ch_callbackarg = NULL;
301 1.1 jmcneill
302 1.1 jmcneill mutex_exit(&sc->sc_lock);
303 1.1 jmcneill }
304 1.1 jmcneill
305 1.1 jmcneill static int
306 1.1 jmcneill sun6idma_transfer(device_t dev, void *priv, struct fdtbus_dma_req *req)
307 1.1 jmcneill {
308 1.1 jmcneill struct sun6idma_softc *sc = device_private(dev);
309 1.1 jmcneill struct sun6idma_channel *ch = priv;
310 1.1 jmcneill struct sun6idma_desc *desc = ch->ch_dmadesc;
311 1.1 jmcneill uint32_t src, dst, len, cfg, mem_cfg, dev_cfg;
312 1.1 jmcneill uint32_t mem_width, dev_width, mem_burst, dev_burst;
313 1.1 jmcneill
314 1.7 jakllsch if (req->dreq_nsegs > sc->sc_ndesc_ch)
315 1.1 jmcneill return EINVAL;
316 1.1 jmcneill
317 1.8 jakllsch if ((sc->sc_widths &
318 1.8 jakllsch IL2B(req->dreq_mem_opt.opt_bus_width/NBBY)) == 0)
319 1.8 jakllsch return EINVAL;
320 1.8 jakllsch if ((sc->sc_widths &
321 1.8 jakllsch IL2B(req->dreq_dev_opt.opt_bus_width/NBBY)) == 0)
322 1.8 jakllsch return EINVAL;
323 1.8 jakllsch if ((sc->sc_bursts &
324 1.8 jakllsch IL2B(req->dreq_mem_opt.opt_burst_len)) == 0)
325 1.8 jakllsch return EINVAL;
326 1.8 jakllsch if ((sc->sc_bursts &
327 1.8 jakllsch IL2B(req->dreq_dev_opt.opt_burst_len)) == 0)
328 1.8 jakllsch return EINVAL;
329 1.8 jakllsch
330 1.1 jmcneill mem_width = DMA_CFG_DATA_WIDTH(req->dreq_mem_opt.opt_bus_width);
331 1.1 jmcneill dev_width = DMA_CFG_DATA_WIDTH(req->dreq_dev_opt.opt_bus_width);
332 1.2 jmcneill mem_burst = DMA_CFG_BST_LEN(req->dreq_mem_opt.opt_burst_len);
333 1.2 jmcneill dev_burst = DMA_CFG_BST_LEN(req->dreq_dev_opt.opt_burst_len);
334 1.1 jmcneill
335 1.1 jmcneill mem_cfg = __SHIFTIN(mem_width, DMA_CFG_SRC_DATA_WIDTH) |
336 1.6 jmcneill __SHIFTIN(mem_burst, sc->sc_burst_mask) |
337 1.1 jmcneill __SHIFTIN(DMA_CFG_ADDR_MODE_LINEAR, DMA_CFG_SRC_ADDR_MODE) |
338 1.1 jmcneill __SHIFTIN(DMA_CFG_DRQ_TYPE_SDRAM, DMA_CFG_SRC_DRQ_TYPE);
339 1.1 jmcneill dev_cfg = __SHIFTIN(dev_width, DMA_CFG_SRC_DATA_WIDTH) |
340 1.6 jmcneill __SHIFTIN(dev_burst, sc->sc_burst_mask) |
341 1.1 jmcneill __SHIFTIN(DMA_CFG_ADDR_MODE_IO, DMA_CFG_SRC_ADDR_MODE) |
342 1.1 jmcneill __SHIFTIN(ch->ch_portid, DMA_CFG_SRC_DRQ_TYPE);
343 1.1 jmcneill
344 1.7 jakllsch for (size_t j = 0; j < req->dreq_nsegs; j++) {
345 1.7 jakllsch if (req->dreq_dir == FDT_DMA_READ) {
346 1.7 jakllsch src = req->dreq_dev_phys;
347 1.7 jakllsch dst = req->dreq_segs[j].ds_addr;
348 1.7 jakllsch cfg = mem_cfg << 16 | dev_cfg;
349 1.7 jakllsch } else {
350 1.7 jakllsch src = req->dreq_segs[j].ds_addr;
351 1.7 jakllsch dst = req->dreq_dev_phys;
352 1.7 jakllsch cfg = dev_cfg << 16 | mem_cfg;
353 1.7 jakllsch }
354 1.7 jakllsch len = req->dreq_segs[j].ds_len;
355 1.7 jakllsch
356 1.7 jakllsch desc[j].dma_config = htole32(cfg);
357 1.7 jakllsch desc[j].dma_srcaddr = htole32(src);
358 1.7 jakllsch desc[j].dma_dstaddr = htole32(dst);
359 1.7 jakllsch desc[j].dma_bcnt = htole32(len);
360 1.7 jakllsch desc[j].dma_para = htole32(0);
361 1.7 jakllsch if (j < req->dreq_nsegs - 1)
362 1.7 jakllsch desc[j].dma_next = htole32(DESC_ADDR(sc, ch, j + 1));
363 1.7 jakllsch else
364 1.7 jakllsch desc[j].dma_next = htole32(DMA_NULL);
365 1.7 jakllsch }
366 1.1 jmcneill
367 1.9 jakllsch #if notyet && maybenever
368 1.8 jakllsch DMA_WRITE(sc, DMA_MODE_REG(ch->ch_index),
369 1.8 jakllsch DMA_MODE_DST(MODE_HANDSHAKE)|DMA_MODE_SRC(MODE_HANDSHAKE));
370 1.8 jakllsch #endif
371 1.8 jakllsch
372 1.7 jakllsch bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap, DESC_OFFS(ch->ch_index, 0),
373 1.7 jakllsch DESC_LEN(req->dreq_nsegs), BUS_DMASYNC_PREWRITE);
374 1.1 jmcneill
375 1.1 jmcneill DMA_WRITE(sc, DMA_START_ADDR_REG(ch->ch_index),
376 1.7 jakllsch DESC_ADDR(sc, ch, 0));
377 1.1 jmcneill DMA_WRITE(sc, DMA_EN_REG(ch->ch_index), DMA_EN_EN);
378 1.1 jmcneill
379 1.2 jmcneill if ((DMA_READ(sc, DMA_EN_REG(ch->ch_index)) & DMA_EN_EN) == 0) {
380 1.2 jmcneill aprint_error_dev(sc->sc_dev,
381 1.2 jmcneill "DMA Channel %u failed to start\n", ch->ch_index);
382 1.2 jmcneill return EIO;
383 1.2 jmcneill }
384 1.2 jmcneill
385 1.1 jmcneill return 0;
386 1.1 jmcneill }
387 1.1 jmcneill
388 1.1 jmcneill static void
389 1.1 jmcneill sun6idma_halt(device_t dev, void *priv)
390 1.1 jmcneill {
391 1.1 jmcneill struct sun6idma_softc *sc = device_private(dev);
392 1.1 jmcneill struct sun6idma_channel *ch = priv;
393 1.1 jmcneill
394 1.1 jmcneill DMA_WRITE(sc, DMA_EN_REG(ch->ch_index), 0);
395 1.1 jmcneill }
396 1.1 jmcneill
397 1.1 jmcneill static const struct fdtbus_dma_controller_func sun6idma_funcs = {
398 1.1 jmcneill .acquire = sun6idma_acquire,
399 1.1 jmcneill .release = sun6idma_release,
400 1.1 jmcneill .transfer = sun6idma_transfer,
401 1.1 jmcneill .halt = sun6idma_halt
402 1.1 jmcneill };
403 1.1 jmcneill
404 1.1 jmcneill static int
405 1.1 jmcneill sun6idma_intr(void *priv)
406 1.1 jmcneill {
407 1.1 jmcneill struct sun6idma_softc *sc = priv;
408 1.1 jmcneill uint32_t pend0, pend1, bit;
409 1.1 jmcneill uint64_t pend, mask;
410 1.1 jmcneill uint8_t index;
411 1.1 jmcneill
412 1.1 jmcneill pend0 = DMA_READ(sc, DMA_IRQ_PEND_REG0_REG);
413 1.1 jmcneill pend1 = DMA_READ(sc, DMA_IRQ_PEND_REG1_REG);
414 1.1 jmcneill if (!pend0 && !pend1)
415 1.1 jmcneill return 0;
416 1.1 jmcneill
417 1.1 jmcneill DMA_WRITE(sc, DMA_IRQ_PEND_REG0_REG, pend0);
418 1.1 jmcneill DMA_WRITE(sc, DMA_IRQ_PEND_REG1_REG, pend1);
419 1.1 jmcneill
420 1.1 jmcneill pend = pend0 | ((uint64_t)pend1 << 32);
421 1.1 jmcneill
422 1.1 jmcneill while ((bit = ffs64(pend & DMA_IRQ_PKG_MASK)) != 0) {
423 1.1 jmcneill mask = __BIT(bit - 1);
424 1.1 jmcneill pend &= ~mask;
425 1.1 jmcneill index = (bit - 1) / 4;
426 1.1 jmcneill
427 1.1 jmcneill if (sc->sc_chan[index].ch_callback == NULL)
428 1.1 jmcneill continue;
429 1.1 jmcneill sc->sc_chan[index].ch_callback(
430 1.1 jmcneill sc->sc_chan[index].ch_callbackarg);
431 1.1 jmcneill }
432 1.1 jmcneill
433 1.1 jmcneill return 1;
434 1.1 jmcneill }
435 1.1 jmcneill
436 1.1 jmcneill static int
437 1.1 jmcneill sun6idma_match(device_t parent, cfdata_t cf, void *aux)
438 1.1 jmcneill {
439 1.1 jmcneill struct fdt_attach_args * const faa = aux;
440 1.1 jmcneill
441 1.14 thorpej return of_compatible_match(faa->faa_phandle, compat_data);
442 1.1 jmcneill }
443 1.1 jmcneill
444 1.1 jmcneill static void
445 1.1 jmcneill sun6idma_attach(device_t parent, device_t self, void *aux)
446 1.1 jmcneill {
447 1.1 jmcneill struct sun6idma_softc * const sc = device_private(self);
448 1.1 jmcneill struct fdt_attach_args * const faa = aux;
449 1.1 jmcneill const int phandle = faa->faa_phandle;
450 1.7 jakllsch size_t desclen;
451 1.4 jmcneill const struct sun6idma_config *conf;
452 1.1 jmcneill struct fdtbus_reset *rst;
453 1.1 jmcneill struct clk *clk;
454 1.1 jmcneill char intrstr[128];
455 1.1 jmcneill bus_addr_t addr;
456 1.1 jmcneill bus_size_t size;
457 1.1 jmcneill int error, nsegs;
458 1.1 jmcneill u_int index;
459 1.1 jmcneill
460 1.1 jmcneill if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
461 1.1 jmcneill aprint_error(": couldn't get registers\n");
462 1.1 jmcneill return;
463 1.1 jmcneill }
464 1.1 jmcneill
465 1.1 jmcneill if ((clk = fdtbus_clock_get_index(phandle, 0)) == NULL ||
466 1.1 jmcneill clk_enable(clk) != 0) {
467 1.1 jmcneill aprint_error(": couldn't enable clock\n");
468 1.1 jmcneill return;
469 1.1 jmcneill }
470 1.1 jmcneill if ((rst = fdtbus_reset_get_index(phandle, 0)) == NULL ||
471 1.1 jmcneill fdtbus_reset_deassert(rst) != 0) {
472 1.1 jmcneill aprint_error(": couldn't de-assert reset\n");
473 1.1 jmcneill return;
474 1.1 jmcneill }
475 1.1 jmcneill
476 1.1 jmcneill sc->sc_dev = self;
477 1.1 jmcneill sc->sc_phandle = phandle;
478 1.1 jmcneill sc->sc_dmat = faa->faa_dmat;
479 1.1 jmcneill sc->sc_bst = faa->faa_bst;
480 1.1 jmcneill if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) {
481 1.1 jmcneill aprint_error(": couldn't map registers\n");
482 1.1 jmcneill return;
483 1.1 jmcneill }
484 1.1 jmcneill mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SCHED);
485 1.1 jmcneill
486 1.1 jmcneill if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
487 1.1 jmcneill aprint_error(": failed to decode interrupt\n");
488 1.1 jmcneill return;
489 1.1 jmcneill }
490 1.1 jmcneill
491 1.14 thorpej conf = of_compatible_lookup(phandle, compat_data)->data;
492 1.4 jmcneill
493 1.6 jmcneill sc->sc_burst_mask = conf->burst_mask;
494 1.4 jmcneill sc->sc_nchan = conf->num_channels;
495 1.8 jakllsch sc->sc_widths = conf->widths;
496 1.8 jakllsch sc->sc_bursts = conf->bursts;
497 1.1 jmcneill sc->sc_chan = kmem_alloc(sizeof(*sc->sc_chan) * sc->sc_nchan, KM_SLEEP);
498 1.7 jakllsch desclen = DESC_OFFS(sc->sc_nchan, 0);
499 1.7 jakllsch sc->sc_ndesc_ch = DESC_OFFS(1, 0) / sizeof(struct sun6idma_desc);
500 1.1 jmcneill
501 1.1 jmcneill aprint_naive("\n");
502 1.1 jmcneill aprint_normal(": DMA controller (%u channels)\n", sc->sc_nchan);
503 1.1 jmcneill
504 1.1 jmcneill DMA_WRITE(sc, DMA_IRQ_EN_REG0_REG, 0);
505 1.1 jmcneill DMA_WRITE(sc, DMA_IRQ_EN_REG1_REG, 0);
506 1.1 jmcneill DMA_WRITE(sc, DMA_IRQ_PEND_REG0_REG, ~0);
507 1.1 jmcneill DMA_WRITE(sc, DMA_IRQ_PEND_REG1_REG, ~0);
508 1.1 jmcneill
509 1.7 jakllsch error = bus_dmamem_alloc(sc->sc_dmat, desclen, 0, 0,
510 1.7 jakllsch sc->sc_dmasegs, 1, &nsegs, BUS_DMA_WAITOK);
511 1.7 jakllsch if (error)
512 1.7 jakllsch panic("bus_dmamem_alloc failed: %d", error);
513 1.7 jakllsch error = bus_dmamem_map(sc->sc_dmat, sc->sc_dmasegs, nsegs,
514 1.7 jakllsch desclen, (void **)&sc->sc_dmadescs, BUS_DMA_WAITOK);
515 1.7 jakllsch if (error)
516 1.7 jakllsch panic("bus_dmamem_map failed: %d", error);
517 1.7 jakllsch error = bus_dmamap_create(sc->sc_dmat, desclen, 1, desclen, 0,
518 1.7 jakllsch BUS_DMA_WAITOK, &sc->sc_dmamap);
519 1.7 jakllsch if (error)
520 1.7 jakllsch panic("bus_dmamap_create failed: %d", error);
521 1.7 jakllsch error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap,
522 1.7 jakllsch sc->sc_dmadescs, desclen, NULL, BUS_DMA_WAITOK);
523 1.7 jakllsch if (error)
524 1.7 jakllsch panic("bus_dmamap_load failed: %d", error);
525 1.7 jakllsch
526 1.1 jmcneill for (index = 0; index < sc->sc_nchan; index++) {
527 1.1 jmcneill struct sun6idma_channel *ch = &sc->sc_chan[index];
528 1.1 jmcneill ch->ch_index = index;
529 1.7 jakllsch ch->ch_dmadesc = (void *)((uintptr_t)sc->sc_dmadescs + DESC_OFFS(index, 0));
530 1.1 jmcneill ch->ch_callback = NULL;
531 1.1 jmcneill ch->ch_callbackarg = NULL;
532 1.1 jmcneill
533 1.1 jmcneill DMA_WRITE(sc, DMA_EN_REG(index), 0);
534 1.1 jmcneill }
535 1.1 jmcneill
536 1.4 jmcneill if (conf->autogate)
537 1.4 jmcneill DMA_WRITE(sc, conf->autogate_reg, conf->autogate_mask);
538 1.4 jmcneill
539 1.10 jmcneill sc->sc_ih = fdtbus_intr_establish_xname(phandle, 0, IPL_SCHED,
540 1.10 jmcneill FDT_INTR_MPSAFE, sun6idma_intr, sc, device_xname(sc->sc_dev));
541 1.1 jmcneill if (sc->sc_ih == NULL) {
542 1.1 jmcneill aprint_error_dev(sc->sc_dev,
543 1.1 jmcneill "couldn't establish interrupt on %s\n", intrstr);
544 1.1 jmcneill return;
545 1.1 jmcneill }
546 1.1 jmcneill aprint_normal_dev(sc->sc_dev, "interrupting on %s\n", intrstr);
547 1.1 jmcneill
548 1.1 jmcneill fdtbus_register_dma_controller(self, phandle, &sun6idma_funcs);
549 1.1 jmcneill }
550 1.1 jmcneill
551 1.1 jmcneill CFATTACH_DECL_NEW(sun6i_dma, sizeof(struct sun6idma_softc),
552 1.1 jmcneill sun6idma_match, sun6idma_attach, NULL, NULL);
553 1.2 jmcneill
554 1.2 jmcneill #ifdef DDB
555 1.2 jmcneill void sun6idma_dump(void);
556 1.2 jmcneill
557 1.2 jmcneill void
558 1.2 jmcneill sun6idma_dump(void)
559 1.2 jmcneill {
560 1.2 jmcneill struct sun6idma_softc *sc;
561 1.2 jmcneill device_t dev;
562 1.2 jmcneill u_int index;
563 1.2 jmcneill
564 1.2 jmcneill dev = device_find_by_driver_unit("sun6idma", 0);
565 1.2 jmcneill if (dev == NULL)
566 1.2 jmcneill return;
567 1.2 jmcneill sc = device_private(dev);
568 1.2 jmcneill
569 1.2 jmcneill device_printf(dev, "DMA_IRQ_EN_REG0_REG: %08x\n", DMA_READ(sc, DMA_IRQ_EN_REG0_REG));
570 1.2 jmcneill device_printf(dev, "DMA_IRQ_EN_REG1_REG: %08x\n", DMA_READ(sc, DMA_IRQ_EN_REG1_REG));
571 1.2 jmcneill device_printf(dev, "DMA_IRQ_PEND_REG0_REG: %08x\n", DMA_READ(sc, DMA_IRQ_PEND_REG0_REG));
572 1.2 jmcneill device_printf(dev, "DMA_IRQ_PEND_REG1_REG: %08x\n", DMA_READ(sc, DMA_IRQ_PEND_REG1_REG));
573 1.2 jmcneill device_printf(dev, "DMA_STA_REG: %08x\n", DMA_READ(sc, DMA_STA_REG));
574 1.2 jmcneill
575 1.2 jmcneill for (index = 0; index < sc->sc_nchan; index++) {
576 1.2 jmcneill struct sun6idma_channel *ch = &sc->sc_chan[index];
577 1.2 jmcneill if (ch->ch_callback == NULL)
578 1.2 jmcneill continue;
579 1.2 jmcneill device_printf(dev, " %2d: DMA_EN_REG: %08x\n", index, DMA_READ(sc, DMA_EN_REG(index)));
580 1.2 jmcneill device_printf(dev, " %2d: DMA_PAU_REG: %08x\n", index, DMA_READ(sc, DMA_PAU_REG(index)));
581 1.2 jmcneill device_printf(dev, " %2d: DMA_START_ADDR_REG: %08x\n", index, DMA_READ(sc, DMA_START_ADDR_REG(index)));
582 1.2 jmcneill device_printf(dev, " %2d: DMA_CFG_REG: %08x\n", index, DMA_READ(sc, DMA_CFG_REG(index)));
583 1.2 jmcneill device_printf(dev, " %2d: DMA_CUR_SRC_REG: %08x\n", index, DMA_READ(sc, DMA_CUR_SRC_REG(index)));
584 1.2 jmcneill device_printf(dev, " %2d: DMA_CUR_DEST_REG: %08x\n", index, DMA_READ(sc, DMA_CUR_DEST_REG(index)));
585 1.2 jmcneill device_printf(dev, " %2d: DMA_BCNT_LEFT_REG: %08x\n", index, DMA_READ(sc, DMA_BCNT_LEFT_REG(index)));
586 1.2 jmcneill device_printf(dev, " %2d: DMA_PARA_REG: %08x\n", index, DMA_READ(sc, DMA_PARA_REG(index)));
587 1.8 jakllsch device_printf(dev, " %2d: DMA_MODE_REG: %08x\n", index, DMA_READ(sc, DMA_MODE_REG(index)));
588 1.8 jakllsch device_printf(dev, " %2d: DMA_FDESC_ADDR_REG: %08x\n", index, DMA_READ(sc, DMA_FDESC_ADDR_REG(index)));
589 1.8 jakllsch device_printf(dev, " %2d: DMA_PKG_NUM_REG: %08x\n", index, DMA_READ(sc, DMA_PKG_NUM_REG(index)));
590 1.2 jmcneill }
591 1.2 jmcneill }
592 1.2 jmcneill #endif
593