1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
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 <plat/dma.h>
31
32#include <mach/hardware.h>
33#include <mach/lcdc.h>
34
35int omap_lcd_dma_running(void)
36{
37
38
39
40
41 if (cpu_is_omap15xx())
42 if (omap_readw(OMAP_LCDC_CONTROL) & OMAP_LCDC_CTRL_LCD_EN)
43 return 1;
44
45
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
53static 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, size;
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
70void 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}
78EXPORT_SYMBOL(omap_set_lcd_dma_b1);
79
80void omap_set_lcd_dma_src_port(int port)
81{
82 lcd_dma.src_port = port;
83}
84
85void omap_set_lcd_dma_ext_controller(int external)
86{
87 lcd_dma.ext_ctrl = external;
88}
89EXPORT_SYMBOL(omap_set_lcd_dma_ext_controller);
90
91void omap_set_lcd_dma_single_transfer(int single)
92{
93 lcd_dma.single_transfer = single;
94}
95EXPORT_SYMBOL(omap_set_lcd_dma_single_transfer);
96
97void omap_set_lcd_dma_b1_rotation(int rotate)
98{
99 if (cpu_is_omap15xx()) {
100 printk(KERN_ERR "DMA rotation is not supported in 1510 mode\n");
101 BUG();
102 return;
103 }
104 lcd_dma.rotate = rotate;
105}
106EXPORT_SYMBOL(omap_set_lcd_dma_b1_rotation);
107
108void omap_set_lcd_dma_b1_mirror(int mirror)
109{
110 if (cpu_is_omap15xx()) {
111 printk(KERN_ERR "DMA mirror is not supported in 1510 mode\n");
112 BUG();
113 }
114 lcd_dma.mirror = mirror;
115}
116EXPORT_SYMBOL(omap_set_lcd_dma_b1_mirror);
117
118void omap_set_lcd_dma_b1_vxres(unsigned long vxres)
119{
120 if (cpu_is_omap15xx()) {
121 printk(KERN_ERR "DMA virtual resolution is not supported "
122 "in 1510 mode\n");
123 BUG();
124 }
125 lcd_dma.vxres = vxres;
126}
127EXPORT_SYMBOL(omap_set_lcd_dma_b1_vxres);
128
129void omap_set_lcd_dma_b1_scale(unsigned int xscale, unsigned int yscale)
130{
131 if (cpu_is_omap15xx()) {
132 printk(KERN_ERR "DMA scale is not supported in 1510 mode\n");
133 BUG();
134 }
135 lcd_dma.xscale = xscale;
136 lcd_dma.yscale = yscale;
137}
138EXPORT_SYMBOL(omap_set_lcd_dma_b1_scale);
139
140static void set_b1_regs(void)
141{
142 unsigned long top, bottom;
143 int es;
144 u16 w;
145 unsigned long en, fn;
146 long ei, fi;
147 unsigned long vxres;
148 unsigned int xscale, yscale;
149
150 switch (lcd_dma.data_type) {
151 case OMAP_DMA_DATA_TYPE_S8:
152 es = 1;
153 break;
154 case OMAP_DMA_DATA_TYPE_S16:
155 es = 2;
156 break;
157 case OMAP_DMA_DATA_TYPE_S32:
158 es = 4;
159 break;
160 default:
161 BUG();
162 return;
163 }
164
165 vxres = lcd_dma.vxres ? lcd_dma.vxres : lcd_dma.xres;
166 xscale = lcd_dma.xscale ? lcd_dma.xscale : 1;
167 yscale = lcd_dma.yscale ? lcd_dma.yscale : 1;
168 BUG_ON(vxres < lcd_dma.xres);
169
170#define PIXADDR(x, y) (lcd_dma.addr + \
171 ((y) * vxres * yscale + (x) * xscale) * es)
172#define PIXSTEP(sx, sy, dx, dy) (PIXADDR(dx, dy) - PIXADDR(sx, sy) - es + 1)
173
174 switch (lcd_dma.rotate) {
175 case 0:
176 if (!lcd_dma.mirror) {
177 top = PIXADDR(0, 0);
178 bottom = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
179
180
181 if (cpu_is_omap15xx() &&
182 lcd_dma.data_type == OMAP_DMA_DATA_TYPE_S32)
183 bottom += 2;
184 ei = PIXSTEP(0, 0, 1, 0);
185 fi = PIXSTEP(lcd_dma.xres - 1, 0, 0, 1);
186 } else {
187 top = PIXADDR(lcd_dma.xres - 1, 0);
188 bottom = PIXADDR(0, lcd_dma.yres - 1);
189 ei = PIXSTEP(1, 0, 0, 0);
190 fi = PIXSTEP(0, 0, lcd_dma.xres - 1, 1);
191 }
192 en = lcd_dma.xres;
193 fn = lcd_dma.yres;
194 break;
195 case 90:
196 if (!lcd_dma.mirror) {
197 top = PIXADDR(0, lcd_dma.yres - 1);
198 bottom = PIXADDR(lcd_dma.xres - 1, 0);
199 ei = PIXSTEP(0, 1, 0, 0);
200 fi = PIXSTEP(0, 0, 1, lcd_dma.yres - 1);
201 } else {
202 top = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
203 bottom = PIXADDR(0, 0);
204 ei = PIXSTEP(0, 1, 0, 0);
205 fi = PIXSTEP(1, 0, 0, lcd_dma.yres - 1);
206 }
207 en = lcd_dma.yres;
208 fn = lcd_dma.xres;
209 break;
210 case 180:
211 if (!lcd_dma.mirror) {
212 top = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
213 bottom = PIXADDR(0, 0);
214 ei = PIXSTEP(1, 0, 0, 0);
215 fi = PIXSTEP(0, 1, lcd_dma.xres - 1, 0);
216 } else {
217 top = PIXADDR(0, lcd_dma.yres - 1);
218 bottom = PIXADDR(lcd_dma.xres - 1, 0);
219 ei = PIXSTEP(0, 0, 1, 0);
220 fi = PIXSTEP(lcd_dma.xres - 1, 1, 0, 0);
221 }
222 en = lcd_dma.xres;
223 fn = lcd_dma.yres;
224 break;
225 case 270:
226 if (!lcd_dma.mirror) {
227 top = PIXADDR(lcd_dma.xres - 1, 0);
228 bottom = PIXADDR(0, lcd_dma.yres - 1);
229 ei = PIXSTEP(0, 0, 0, 1);
230 fi = PIXSTEP(1, lcd_dma.yres - 1, 0, 0);
231 } else {
232 top = PIXADDR(0, 0);
233 bottom = PIXADDR(lcd_dma.xres - 1, lcd_dma.yres - 1);
234 ei = PIXSTEP(0, 0, 0, 1);
235 fi = PIXSTEP(0, lcd_dma.yres - 1, 1, 0);
236 }
237 en = lcd_dma.yres;
238 fn = lcd_dma.xres;
239 break;
240 default:
241 BUG();
242 return;
243 }
244
245 if (cpu_is_omap15xx()) {
246 omap_writew(top >> 16, OMAP1510_DMA_LCD_TOP_F1_U);
247 omap_writew(top, OMAP1510_DMA_LCD_TOP_F1_L);
248 omap_writew(bottom >> 16, OMAP1510_DMA_LCD_BOT_F1_U);
249 omap_writew(bottom, OMAP1510_DMA_LCD_BOT_F1_L);
250
251 return;
252 }
253
254
255 omap_writew(top >> 16, OMAP1610_DMA_LCD_TOP_B1_U);
256 omap_writew(top, OMAP1610_DMA_LCD_TOP_B1_L);
257 omap_writew(bottom >> 16, OMAP1610_DMA_LCD_BOT_B1_U);
258 omap_writew(bottom, OMAP1610_DMA_LCD_BOT_B1_L);
259
260 omap_writew(en, OMAP1610_DMA_LCD_SRC_EN_B1);
261 omap_writew(fn, OMAP1610_DMA_LCD_SRC_FN_B1);
262
263 w = omap_readw(OMAP1610_DMA_LCD_CSDP);
264 w &= ~0x03;
265 w |= lcd_dma.data_type;
266 omap_writew(w, OMAP1610_DMA_LCD_CSDP);
267
268 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
269
270 w &= ~(0x03 << 6);
271 if (lcd_dma.callback != NULL)
272 w |= 1 << 1;
273 else
274 w &= ~(1 << 1);
275 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
276
277 if (!(lcd_dma.rotate || lcd_dma.mirror ||
278 lcd_dma.vxres || lcd_dma.xscale || lcd_dma.yscale))
279 return;
280
281 w = omap_readw(OMAP1610_DMA_LCD_CCR);
282
283 w |= (0x03 << 12);
284 omap_writew(w, OMAP1610_DMA_LCD_CCR);
285
286 omap_writew(ei, OMAP1610_DMA_LCD_SRC_EI_B1);
287 omap_writew(fi >> 16, OMAP1610_DMA_LCD_SRC_FI_B1_U);
288 omap_writew(fi, OMAP1610_DMA_LCD_SRC_FI_B1_L);
289}
290
291static irqreturn_t lcd_dma_irq_handler(int irq, void *dev_id)
292{
293 u16 w;
294
295 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
296 if (unlikely(!(w & (1 << 3)))) {
297 printk(KERN_WARNING "Spurious LCD DMA IRQ\n");
298 return IRQ_NONE;
299 }
300
301 w |= (1 << 3);
302 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
303 lcd_dma.active = 0;
304 if (lcd_dma.callback != NULL)
305 lcd_dma.callback(w, lcd_dma.cb_data);
306
307 return IRQ_HANDLED;
308}
309
310int omap_request_lcd_dma(void (*callback)(u16 status, void *data),
311 void *data)
312{
313 spin_lock_irq(&lcd_dma.lock);
314 if (lcd_dma.reserved) {
315 spin_unlock_irq(&lcd_dma.lock);
316 printk(KERN_ERR "LCD DMA channel already reserved\n");
317 BUG();
318 return -EBUSY;
319 }
320 lcd_dma.reserved = 1;
321 spin_unlock_irq(&lcd_dma.lock);
322 lcd_dma.callback = callback;
323 lcd_dma.cb_data = data;
324 lcd_dma.active = 0;
325 lcd_dma.single_transfer = 0;
326 lcd_dma.rotate = 0;
327 lcd_dma.vxres = 0;
328 lcd_dma.mirror = 0;
329 lcd_dma.xscale = 0;
330 lcd_dma.yscale = 0;
331 lcd_dma.ext_ctrl = 0;
332 lcd_dma.src_port = 0;
333
334 return 0;
335}
336EXPORT_SYMBOL(omap_request_lcd_dma);
337
338void omap_free_lcd_dma(void)
339{
340 spin_lock(&lcd_dma.lock);
341 if (!lcd_dma.reserved) {
342 spin_unlock(&lcd_dma.lock);
343 printk(KERN_ERR "LCD DMA is not reserved\n");
344 BUG();
345 return;
346 }
347 if (!cpu_is_omap15xx())
348 omap_writew(omap_readw(OMAP1610_DMA_LCD_CCR) & ~1,
349 OMAP1610_DMA_LCD_CCR);
350 lcd_dma.reserved = 0;
351 spin_unlock(&lcd_dma.lock);
352}
353EXPORT_SYMBOL(omap_free_lcd_dma);
354
355void omap_enable_lcd_dma(void)
356{
357 u16 w;
358
359
360
361
362
363
364 if (cpu_is_omap15xx() || !lcd_dma.ext_ctrl)
365 return;
366
367 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
368 w |= 1 << 8;
369 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
370
371 lcd_dma.active = 1;
372
373 w = omap_readw(OMAP1610_DMA_LCD_CCR);
374 w |= 1 << 7;
375 omap_writew(w, OMAP1610_DMA_LCD_CCR);
376}
377EXPORT_SYMBOL(omap_enable_lcd_dma);
378
379void omap_setup_lcd_dma(void)
380{
381 BUG_ON(lcd_dma.active);
382 if (!cpu_is_omap15xx()) {
383
384 omap_writew(0x5440, OMAP1610_DMA_LCD_CCR);
385 omap_writew(0x9102, OMAP1610_DMA_LCD_CSDP);
386 omap_writew(0x0004, OMAP1610_DMA_LCD_LCH_CTRL);
387 }
388 set_b1_regs();
389 if (!cpu_is_omap15xx()) {
390 u16 w;
391
392 w = omap_readw(OMAP1610_DMA_LCD_CCR);
393
394
395
396
397
398 w |= 1 << 11;
399 if (!lcd_dma.single_transfer)
400 w |= (3 << 8);
401 omap_writew(w, OMAP1610_DMA_LCD_CCR);
402 }
403}
404EXPORT_SYMBOL(omap_setup_lcd_dma);
405
406void omap_stop_lcd_dma(void)
407{
408 u16 w;
409
410 lcd_dma.active = 0;
411 if (cpu_is_omap15xx() || !lcd_dma.ext_ctrl)
412 return;
413
414 w = omap_readw(OMAP1610_DMA_LCD_CCR);
415 w &= ~(1 << 7);
416 omap_writew(w, OMAP1610_DMA_LCD_CCR);
417
418 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
419 w &= ~(1 << 8);
420 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
421}
422EXPORT_SYMBOL(omap_stop_lcd_dma);
423
424static int __init omap_init_lcd_dma(void)
425{
426 int r;
427
428 if (!cpu_class_is_omap1())
429 return -ENODEV;
430
431 if (cpu_is_omap16xx()) {
432 u16 w;
433
434
435 w = omap_readw(OMAP1610_DMA_LCD_CTRL);
436 w &= ~(1 << 8);
437 omap_writew(w, OMAP1610_DMA_LCD_CTRL);
438 }
439
440 spin_lock_init(&lcd_dma.lock);
441
442 r = request_irq(INT_DMA_LCD, lcd_dma_irq_handler, 0,
443 "LCD DMA", NULL);
444 if (r != 0)
445 printk(KERN_ERR "unable to request IRQ for LCD DMA "
446 "(error %d)\n", r);
447
448 return r;
449}
450
451arch_initcall(omap_init_lcd_dma);
452
453
