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