update from upstream
[linux-2.6] / drivers / video / backlight / locomolcd.c
1 /*
2  * Backlight control code for Sharp Zaurus SL-5500
3  *
4  * Copyright 2005 John Lenz <lenz@cs.wisc.edu>
5  * Maintainer: Pavel Machek <pavel@suse.cz> (unless John wants to :-)
6  * GPL v2
7  *
8  * This driver assumes single CPU. That's okay, because collie is
9  * slightly old hardware, and noone is going to retrofit second CPU to
10  * old PDA.
11  */
12
13 /* LCD power functions */
14 #include <linux/config.h>
15 #include <linux/module.h>
16 #include <linux/init.h>
17 #include <linux/delay.h>
18 #include <linux/device.h>
19 #include <linux/interrupt.h>
20
21 #include <asm/hardware/locomo.h>
22 #include <asm/irq.h>
23
24 #ifdef CONFIG_SA1100_COLLIE
25 #include <asm/arch/collie.h>
26 #else
27 #include <asm/arch/poodle.h>
28 #endif
29
30 extern void (*sa1100fb_lcd_power)(int on);
31
32 static struct locomo_dev *locomolcd_dev;
33
34 static void locomolcd_on(int comadj)
35 {
36         locomo_gpio_set_dir(locomolcd_dev, LOCOMO_GPIO_LCD_VSHA_ON, 0);
37         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_VSHA_ON, 1);
38         mdelay(2);
39
40         locomo_gpio_set_dir(locomolcd_dev, LOCOMO_GPIO_LCD_VSHD_ON, 0);
41         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_VSHD_ON, 1);
42         mdelay(2);
43
44         locomo_m62332_senddata(locomolcd_dev, comadj, 0);
45         mdelay(5);
46
47         locomo_gpio_set_dir(locomolcd_dev, LOCOMO_GPIO_LCD_VEE_ON, 0);
48         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_VEE_ON, 1);
49         mdelay(10);
50
51         /* TFTCRST | CPSOUT=0 | CPSEN */
52         locomo_writel(0x01, locomolcd_dev->mapbase + LOCOMO_TC);
53
54         /* Set CPSD */
55         locomo_writel(6, locomolcd_dev->mapbase + LOCOMO_CPSD);
56
57         /* TFTCRST | CPSOUT=0 | CPSEN */
58         locomo_writel((0x04 | 0x01), locomolcd_dev->mapbase + LOCOMO_TC);
59         mdelay(10);
60
61         locomo_gpio_set_dir(locomolcd_dev, LOCOMO_GPIO_LCD_MOD, 0);
62         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_MOD, 1);
63 }
64
65 static void locomolcd_off(int comadj)
66 {
67         /* TFTCRST=1 | CPSOUT=1 | CPSEN = 0 */
68         locomo_writel(0x06, locomolcd_dev->mapbase + LOCOMO_TC);
69         mdelay(1);
70
71         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_VSHA_ON, 0);
72         mdelay(110);
73
74         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_VEE_ON, 0);
75         mdelay(700);
76
77         /* TFTCRST=0 | CPSOUT=0 | CPSEN = 0 */
78         locomo_writel(0, locomolcd_dev->mapbase + LOCOMO_TC);
79         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_MOD, 0);
80         locomo_gpio_write(locomolcd_dev, LOCOMO_GPIO_LCD_VSHD_ON, 0);
81 }
82
83 void locomolcd_power(int on)
84 {
85         int comadj = 118;
86         unsigned long flags;
87
88         local_irq_save(flags);
89
90         if (!locomolcd_dev) {
91                 local_irq_restore(flags);
92                 return;
93         }
94
95         /* read comadj */
96 #ifdef CONFIG_MACH_POODLE
97         comadj = 118;
98 #else
99         comadj = 128;
100 #endif
101
102         if (on)
103                 locomolcd_on(comadj);
104         else
105                 locomolcd_off(comadj);
106
107         local_irq_restore(flags);
108 }
109 EXPORT_SYMBOL(locomolcd_power);
110
111 static int poodle_lcd_probe(struct locomo_dev *dev)
112 {
113         unsigned long flags;
114
115         local_irq_save(flags);
116         locomolcd_dev = dev;
117
118         /* the poodle_lcd_power function is called for the first time
119          * from fs_initcall, which is before locomo is activated.
120          * We need to recall poodle_lcd_power here*/
121 #ifdef CONFIG_MACH_POODLE
122         locomolcd_power(1);
123 #endif
124         local_irq_restore(flags);
125         return 0;
126 }
127
128 static int poodle_lcd_remove(struct locomo_dev *dev)
129 {
130         unsigned long flags;
131         local_irq_save(flags);
132         locomolcd_dev = NULL;
133         local_irq_restore(flags);
134         return 0;
135 }
136
137 static struct locomo_driver poodle_lcd_driver = {
138         .drv = {
139                 .name = "locomo-backlight",
140         },
141         .devid  = LOCOMO_DEVID_BACKLIGHT,
142         .probe  = poodle_lcd_probe,
143         .remove = poodle_lcd_remove,
144 };
145
146 static int __init poodle_lcd_init(void)
147 {
148         int ret = locomo_driver_register(&poodle_lcd_driver);
149         if (ret) return ret;
150
151 #ifdef CONFIG_SA1100_COLLIE
152         sa1100fb_lcd_power = locomolcd_power;
153 #endif
154         return 0;
155 }
156 device_initcall(poodle_lcd_init);
157