Linux Audio

Check our new training course

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