1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * linux/arch/arm/mach-omap1/lcd_dma.c
4 *
5 * Extracted from arch/arm/plat-omap/dma.c
6 * Copyright (C) 2003 - 2008 Nokia Corporation
7 * Author: Juha Yrjölä <juha.yrjola@nokia.com>
8 * DMA channel linking for 1610 by Samuel Ortiz <samuel.ortiz@nokia.com>
9 * Graphics DMA and LCD DMA graphics tranformations
10 * by Imre Deak <imre.deak@nokia.com>
11 * OMAP2/3 support Copyright (C) 2004-2007 Texas Instruments, Inc.
12 * Merged to support both OMAP1 and OMAP2 by Tony Lindgren <tony@atomide.com>
13 * Some functions based on earlier dma-omap.c Copyright (C) 2001 RidgeRun, Inc.
14 *
15 * Copyright (C) 2009 Texas Instruments
16 * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
17 *
18 * Support functions for the OMAP internal DMA channels.
19 */
20
21 #include <linux/module.h>
22 #include <linux/spinlock.h>
23 #include <linux/interrupt.h>
24 #include <linux/io.h>
25
26 #include <linux/omap-dma.h>
27
28 #include <mach/hardware.h>
29 #include <mach/lcdc.h>
30
omap_lcd_dma_running(void)31 int omap_lcd_dma_running(void)
32 {
33 /*
34 * On OMAP1510, internal LCD controller will start the transfer
35 * when it gets enabled, so assume DMA running if LCD enabled.
36 */
37 if (cpu_is_omap15xx())
38 if (omap_readw(OMAP_LCDC_CONTROL) & OMAP_LCDC_CTRL_LCD_EN)
39 return 1;
40
41 /* Check if LCD DMA is running */
42 if (cpu_is_omap16xx())
43 if (omap_readw(OMAP1610_DMA_LCD_CCR) & OMAP_DMA_CCR_EN)
44 return 1;
45
46 return 0;
47 }
48
49 static struct lcd_dma_info {
50 spinlock_t lock;
51 int reserved;
52 void (*callback)(u16 status, void *data);
53 void *cb_data;
54
55 int active;
56 unsigned long addr;
57 int rotate, data_type, xres, yres;
58 int vxres;
59 int mirror;
60 int xscale, yscale;
61 int ext_ctrl;
62 int src_port;
63 int single_transfer;
64 } lcd_dma;
65
omap_set_lcd_dma_b1(unsigned long addr,u16 fb_xres,u16 fb_yres,int data_type)66 void omap_set_lcd_dma_b1(unsigned long addr, u16 fb_xres, u16 fb_yres,
67 int data_type)
68 {
69 lcd_dma.addr = addr;
70 lcd_dma.data_type = data_type;
71 lcd_dma.xres = fb_xres;
72 lcd_dma.yres = fb_yres;
73 }
74 EXPORT_SYMBOL(omap_set_lcd_dma_b1);
75
omap_set_lcd_dma_ext_controller(int external)76 void omap_set_lcd_dma_ext_controller(int external)
77 {
78 lcd_dma.ext_ctrl = external;
79 }
80 EXPORT_SYMBOL(omap_set_lcd_dma_ext_controller);
81
omap_set_lcd_dma_single_transfer(int single)82 void omap_set_lcd_dma_single_transfer(int single)
83 {
84 lcd_dma.single_transfer = single;
85 }
86 EXPORT_SYMBOL(omap_set_lcd_dma_single_transfer);
87
omap_set_lcd_dma_b1_rotation(int rotate)88 void omap_set_lcd_dma_b1_rotation(int rotate)
89 {
90 if (cpu_is_omap15xx()) {
91 printk(KERN_ERR "DMA rotation is not supported in 1510 mode\n");
92 BUG();
93 return;
94 }
95 lcd_dma.rotate = rotate;
96 }
97 EXPORT_SYMBOL(omap_set_lcd_dma_b1_rotation);
98
omap_set_lcd_dma_b1_mirror(int mirror)99 void omap_set_lcd_dma_b1_mirror(int mirror)
100 {
101 if (cpu_is_omap15xx()) {
102 printk(KERN_ERR "DMA mirror is not supported in 1510 mode\n");
103 BUG();
104 }
105 lcd_dma.mirror = mirror;
106 }
107 EXPORT_SYMBOL(omap_set_lcd_dma_b1_mirror);
108
omap_set_lcd_dma_b1_vxres(unsigned long vxres)109 void omap_set_lcd_dma_b1_vxres(unsigned long vxres)
110 {
111 if (cpu_is_omap15xx()) {
112 pr_err("DMA virtual resolution is not supported in 1510 mode\n");
113 BUG();
114 }
115 lcd_dma.vxres = vxres;
116 }
117 EXPORT_SYMBOL(omap_set_lcd_dma_b1_vxres);
118
omap_set_lcd_dma_b1_scale(unsigned int xscale,unsigned int yscale)119 void omap_set_lcd_dma_b1_scale(unsigned int xscale, unsigned int yscale)
120 {
121 if (cpu_is_omap15xx()) {
122 printk(KERN_ERR "DMA scale is not supported in 1510 mode\n");
123 BUG();
124 }
125 lcd_dma.xscale = xscale;
126 lcd_dma.yscale = yscale;
127 }
128 EXPORT_SYMBOL(omap_set_lcd_dma_b1_scale);
129
set_b1_regs(void)130 static void set_b1_regs(void)
131 {
132 unsigned long top, bottom;
133 int es;
134 u16 w;
135 unsigned long en, fn;
136 long ei, fi;
137 unsigned long vxres;
138 unsigned int xscale, yscale;
139
140 switch (lcd_dma.data_type) {
141 case OMAP_DMA_DATA_TYPE_S8:
142 es = 1;
143 break;
144 case OMAP_DMA_DATA_TYPE_S16:
145 es = 2;
146 break;
147 case OMAP_DMA_DATA_TYPE_S32:
148 es = 4;
149 break;
150 default:
151 BUG();
152 return;
153 }
154
155 vxres = lcd_dma.vxres ? lcd_dma.vxres : lcd_dma.xres;
156 xscale = lcd_dma.xscale ? lcd_dma.xscale : 1;
157 yscale = lcd_dma.yscale ? lcd_dma.yscale : 1;
158 BUG_ON(vxres < lcd_dma.xres);
159
160 #define PIXADDR(x, y) (lcd_dma.addr + \
161 ((y) * vxres * yscale + (x) * xscale) * es)
162 #define PIXSTEP(sx, sy, dx, dy) (PIXADDR(dx, dy) - PIXADDR(sx, sy) - es + 1)
163
164 switch (lcd_dma.rotate) {
165 case 0:
166 if (!lcd_dma.mirror) {
167 top = PIXADDR(0, 0);
168 bottom = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
169 /* 1510 DMA requires the bottom address to be 2 more
170 * than the actual last memory access location. */
171 if (cpu_is_omap15xx() &&
172 lcd_dma.data_type == OMAP_DMA_DATA_TYPE_S32)
173 bottom += 2;
174 ei = PIXSTEP(0, 0, 1, 0);
175 fi = PIXSTEP(lcd_dma.xres - 1, 0, 0, 1);
176 } else {
177 top = PIXADDR(lcd_dma.xres - 1, 0);
178 bottom = PIXADDR(0, lcd_dma.yres - 1);
179 ei = PIXSTEP(1, 0, 0, 0);
180 fi = PIXSTEP(0, 0, lcd_dma.xres - 1, 1);
181 }
182 en = lcd_dma.xres;
183 fn = lcd_dma.yres;
184 break;
185 case 90:
186 if (!lcd_dma.mirror) {
187 top = PIXADDR(0, lcd_dma.yres - 1);
188 bottom = PIXADDR(lcd_dma.xres - 1, 0);
189 ei = PIXSTEP(0, 1, 0, 0);
190 fi = PIXSTEP(0, 0, 1, lcd_dma.yres - 1);
191 } else {
192 top = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
193 bottom = PIXADDR(0, 0);
194 ei = PIXSTEP(0, 1, 0, 0);
195 fi = PIXSTEP(1, 0, 0, lcd_dma.yres - 1);
196 }
197 en = lcd_dma.yres;
198 fn = lcd_dma.xres;
199 break;
200 case 180:
201 if (!lcd_dma.mirror) {
202 top = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
203 bottom = PIXADDR(0, 0);
204 ei = PIXSTEP(1, 0, 0, 0);
205 fi = PIXSTEP(0, 1, lcd_dma.xres - 1, 0);
206 } else {
207 top = PIXADDR(0, lcd_dma.yres - 1);
208 bottom = PIXADDR(lcd_dma.xres - 1, 0);
209 ei = PIXSTEP(0, 0, 1, 0);
210 fi = PIXSTEP(lcd_dma.xres - 1, 1, 0, 0);
211 }
212 en = lcd_dma.xres;
213 fn = lcd_dma.yres;
214 break;
215 case 270:
216 if (!lcd_dma.mirror) {
217 top = PIXADDR(lcd_dma.xres - 1, 0);
218 bottom = PIXADDR(0, lcd_dma.yres - 1);
219 ei = PIXSTEP(0, 0, 0, 1);
220 fi = PIXSTEP(1, lcd_dma.yres - 1, 0, 0);
221 } else {
222 top = PIXADDR(0, 0);
223 bottom = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
224 ei = PIXSTEP(0, 0, 0, 1);
225 fi = PIXSTEP(0, lcd_dma.yres - 1, 1, 0);
226 }
227 en = lcd_dma.yres;
228 fn = lcd_dma.xres;
229 break;
230 default:
231 BUG();
232 return; /* Suppress warning about uninitialized vars */
233 }
234
235 if (cpu_is_omap15xx()) {
236 omap_writew(top >> 16, OMAP1510_DMA_LCD_TOP_F1_U);
237 omap_writew(top, OMAP1510_DMA_LCD_TOP_F1_L);
238 omap_writew(bottom >> 16, OMAP1510_DMA_LCD_BOT_F1_U);
239 omap_writew(bottom, OMAP1510_DMA_LCD_BOT_F1_L);
240
241 return;
242 }
243
244 /* 1610 regs */
245 omap_writew(top >> 16, OMAP1610_DMA_LCD_TOP_B1_U);
246 omap_writew(top, OMAP1610_DMA_LCD_TOP_B1_L);
247 omap_writew(bottom >> 16, OMAP1610_DMA_LCD_BOT_B1_U);
248 omap_writew(bottom, OMAP1610_DMA_LCD_BOT_B1_L);
249
250 omap_writew(en, OMAP1610_DMA_LCD_SRC_EN_B1);
251 omap_writew(fn, OMAP1610_DMA_LCD_SRC_FN_B1);
252
253 w = omap_readw(OMAP1610_DMA_LCD_CSDP);
254 w &= ~0x03;
255 w |= lcd_dma.data_type;
256 omap_writew(w, OMAP1610_DMA_LCD_CSDP);
257
258 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
259 /* Always set the source port as SDRAM for now*/
260 w &= ~(0x03 << 6);
261 if (lcd_dma.callback != NULL)
262 w |= 1 << 1; /* Block interrupt enable */
263 else
264 w &= ~(1 << 1);
265 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
266
267 if (!(lcd_dma.rotate || lcd_dma.mirror ||
268 lcd_dma.vxres || lcd_dma.xscale || lcd_dma.yscale))
269 return;
270
271 w = omap_readw(OMAP1610_DMA_LCD_CCR);
272 /* Set the double-indexed addressing mode */
273 w |= (0x03 << 12);
274 omap_writew(w, OMAP1610_DMA_LCD_CCR);
275
276 omap_writew(ei, OMAP1610_DMA_LCD_SRC_EI_B1);
277 omap_writew(fi >> 16, OMAP1610_DMA_LCD_SRC_FI_B1_U);
278 omap_writew(fi, OMAP1610_DMA_LCD_SRC_FI_B1_L);
279 }
280
lcd_dma_irq_handler(int irq,void * dev_id)281 static irqreturn_t lcd_dma_irq_handler(int irq, void *dev_id)
282 {
283 u16 w;
284
285 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
286 if (unlikely(!(w & (1 << 3)))) {
287 printk(KERN_WARNING "Spurious LCD DMA IRQ\n");
288 return IRQ_NONE;
289 }
290 /* Ack the IRQ */
291 w |= (1 << 3);
292 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
293 lcd_dma.active = 0;
294 if (lcd_dma.callback != NULL)
295 lcd_dma.callback(w, lcd_dma.cb_data);
296
297 return IRQ_HANDLED;
298 }
299
omap_request_lcd_dma(void (* callback)(u16 status,void * data),void * data)300 int omap_request_lcd_dma(void (*callback)(u16 status, void *data),
301 void *data)
302 {
303 spin_lock_irq(&lcd_dma.lock);
304 if (lcd_dma.reserved) {
305 spin_unlock_irq(&lcd_dma.lock);
306 printk(KERN_ERR "LCD DMA channel already reserved\n");
307 BUG();
308 return -EBUSY;
309 }
310 lcd_dma.reserved = 1;
311 spin_unlock_irq(&lcd_dma.lock);
312 lcd_dma.callback = callback;
313 lcd_dma.cb_data = data;
314 lcd_dma.active = 0;
315 lcd_dma.single_transfer = 0;
316 lcd_dma.rotate = 0;
317 lcd_dma.vxres = 0;
318 lcd_dma.mirror = 0;
319 lcd_dma.xscale = 0;
320 lcd_dma.yscale = 0;
321 lcd_dma.ext_ctrl = 0;
322 lcd_dma.src_port = 0;
323
324 return 0;
325 }
326 EXPORT_SYMBOL(omap_request_lcd_dma);
327
omap_free_lcd_dma(void)328 void omap_free_lcd_dma(void)
329 {
330 spin_lock(&lcd_dma.lock);
331 if (!lcd_dma.reserved) {
332 spin_unlock(&lcd_dma.lock);
333 printk(KERN_ERR "LCD DMA is not reserved\n");
334 BUG();
335 return;
336 }
337 if (!cpu_is_omap15xx())
338 omap_writew(omap_readw(OMAP1610_DMA_LCD_CCR) & ~1,
339 OMAP1610_DMA_LCD_CCR);
340 lcd_dma.reserved = 0;
341 spin_unlock(&lcd_dma.lock);
342 }
343 EXPORT_SYMBOL(omap_free_lcd_dma);
344
omap_enable_lcd_dma(void)345 void omap_enable_lcd_dma(void)
346 {
347 u16 w;
348
349 /*
350 * Set the Enable bit only if an external controller is
351 * connected. Otherwise the OMAP internal controller will
352 * start the transfer when it gets enabled.
353 */
354 if (cpu_is_omap15xx() || !lcd_dma.ext_ctrl)
355 return;
356
357 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
358 w |= 1 << 8;
359 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
360
361 lcd_dma.active = 1;
362
363 w = omap_readw(OMAP1610_DMA_LCD_CCR);
364 w |= 1 << 7;
365 omap_writew(w, OMAP1610_DMA_LCD_CCR);
366 }
367 EXPORT_SYMBOL(omap_enable_lcd_dma);
368
omap_setup_lcd_dma(void)369 void omap_setup_lcd_dma(void)
370 {
371 BUG_ON(lcd_dma.active);
372 if (!cpu_is_omap15xx()) {
373 /* Set some reasonable defaults */
374 omap_writew(0x5440, OMAP1610_DMA_LCD_CCR);
375 omap_writew(0x9102, OMAP1610_DMA_LCD_CSDP);
376 omap_writew(0x0004, OMAP1610_DMA_LCD_LCH_CTRL);
377 }
378 set_b1_regs();
379 if (!cpu_is_omap15xx()) {
380 u16 w;
381
382 w = omap_readw(OMAP1610_DMA_LCD_CCR);
383 /*
384 * If DMA was already active set the end_prog bit to have
385 * the programmed register set loaded into the active
386 * register set.
387 */
388 w |= 1 << 11; /* End_prog */
389 if (!lcd_dma.single_transfer)
390 w |= (3 << 8); /* Auto_init, repeat */
391 omap_writew(w, OMAP1610_DMA_LCD_CCR);
392 }
393 }
394 EXPORT_SYMBOL(omap_setup_lcd_dma);
395
omap_stop_lcd_dma(void)396 void omap_stop_lcd_dma(void)
397 {
398 u16 w;
399
400 lcd_dma.active = 0;
401 if (cpu_is_omap15xx() || !lcd_dma.ext_ctrl)
402 return;
403
404 w = omap_readw(OMAP1610_DMA_LCD_CCR);
405 w &= ~(1 << 7);
406 omap_writew(w, OMAP1610_DMA_LCD_CCR);
407
408 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
409 w &= ~(1 << 8);
410 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
411 }
412 EXPORT_SYMBOL(omap_stop_lcd_dma);
413
omap_init_lcd_dma(void)414 static int __init omap_init_lcd_dma(void)
415 {
416 int r;
417
418 if (!cpu_class_is_omap1())
419 return -ENODEV;
420
421 if (cpu_is_omap16xx()) {
422 u16 w;
423
424 /* this would prevent OMAP sleep */
425 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
426 w &= ~(1 << 8);
427 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
428 }
429
430 spin_lock_init(&lcd_dma.lock);
431
432 r = request_irq(INT_DMA_LCD, lcd_dma_irq_handler, 0,
433 "LCD DMA", NULL);
434 if (r != 0)
435 pr_err("unable to request IRQ for LCD DMA (error %d)\n", r);
436
437 return r;
438 }
439
440 arch_initcall(omap_init_lcd_dma);
441
442