1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
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
31int omap_lcd_dma_running(void)
32{
33
34
35
36
37 if (cpu_is_omap15xx())
38 if (omap_readw(OMAP_LCDC_CONTROL) & OMAP_LCDC_CTRL_LCD_EN)
39 return 1;
40
41
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
49static 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
66void 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}
74EXPORT_SYMBOL(omap_set_lcd_dma_b1);
75
76void omap_set_lcd_dma_ext_controller(int external)
77{
78 lcd_dma.ext_ctrl = external;
79}
80EXPORT_SYMBOL(omap_set_lcd_dma_ext_controller);
81
82void omap_set_lcd_dma_single_transfer(int single)
83{
84 lcd_dma.single_transfer = single;
85}
86EXPORT_SYMBOL(omap_set_lcd_dma_single_transfer);
87
88void 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}
97EXPORT_SYMBOL(omap_set_lcd_dma_b1_rotation);
98
99void 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}
107EXPORT_SYMBOL(omap_set_lcd_dma_b1_mirror);
108
109void 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}
117EXPORT_SYMBOL(omap_set_lcd_dma_b1_vxres);
118
119void 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}
128EXPORT_SYMBOL(omap_set_lcd_dma_b1_scale);
129
130static 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
170
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;
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
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
260 w &= ~(0x03 << 6);
261 if (lcd_dma.callback != NULL)
262 w |= 1 << 1;
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
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
281static 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
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
300int 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}
326EXPORT_SYMBOL(omap_request_lcd_dma);
327
328void 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}
343EXPORT_SYMBOL(omap_free_lcd_dma);
344
345void omap_enable_lcd_dma(void)
346{
347 u16 w;
348
349
350
351
352
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}
367EXPORT_SYMBOL(omap_enable_lcd_dma);
368
369void omap_setup_lcd_dma(void)
370{
371 BUG_ON(lcd_dma.active);
372 if (!cpu_is_omap15xx()) {
373
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
385
386
387
388 w |= 1 << 11;
389 if (!lcd_dma.single_transfer)
390 w |= (3 << 8);
391 omap_writew(w, OMAP1610_DMA_LCD_CCR);
392 }
393}
394EXPORT_SYMBOL(omap_setup_lcd_dma);
395
396void 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}
412EXPORT_SYMBOL(omap_stop_lcd_dma);
413
414static 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
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
440arch_initcall(omap_init_lcd_dma);
441
442
