viafb: use proper pci config API
[linux/fpc-iii.git] / drivers / video / backlight / locomolcd.c
blob7571bc26071e7039f5b9c064604e5077cdf4bf79
1 /*
2 * Backlight control code for Sharp Zaurus SL-5500
4 * Copyright 2005 John Lenz <lenz@cs.wisc.edu>
5 * Maintainer: Pavel Machek <pavel@suse.cz> (unless John wants to :-)
6 * GPL v2
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.
13 /* LCD power functions */
14 #include <linux/module.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
17 #include <linux/device.h>
18 #include <linux/interrupt.h>
19 #include <linux/fb.h>
20 #include <linux/backlight.h>
22 #include <asm/hardware/locomo.h>
23 #include <asm/irq.h>
24 #include <asm/mach/sharpsl_param.h>
25 #include <asm/mach-types.h>
27 #include "../../../arch/arm/mach-sa1100/generic.h"
29 static struct backlight_device *locomolcd_bl_device;
30 static struct locomo_dev *locomolcd_dev;
31 static unsigned long locomolcd_flags;
32 #define LOCOMOLCD_SUSPENDED 0x01
34 static void locomolcd_on(int comadj)
36 locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
37 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 1);
38 mdelay(2);
40 locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
41 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 1);
42 mdelay(2);
44 locomo_m62332_senddata(locomolcd_dev, comadj, 0);
45 mdelay(5);
47 locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
48 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 1);
49 mdelay(10);
51 /* TFTCRST | CPSOUT=0 | CPSEN */
52 locomo_writel(0x01, locomolcd_dev->mapbase + LOCOMO_TC);
54 /* Set CPSD */
55 locomo_writel(6, locomolcd_dev->mapbase + LOCOMO_CPSD);
57 /* TFTCRST | CPSOUT=0 | CPSEN */
58 locomo_writel((0x04 | 0x01), locomolcd_dev->mapbase + LOCOMO_TC);
59 mdelay(10);
61 locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
62 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 1);
65 static void locomolcd_off(int comadj)
67 /* TFTCRST=1 | CPSOUT=1 | CPSEN = 0 */
68 locomo_writel(0x06, locomolcd_dev->mapbase + LOCOMO_TC);
69 mdelay(1);
71 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
72 mdelay(110);
74 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
75 mdelay(700);
77 /* TFTCRST=0 | CPSOUT=0 | CPSEN = 0 */
78 locomo_writel(0, locomolcd_dev->mapbase + LOCOMO_TC);
79 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
80 locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
83 void locomolcd_power(int on)
85 int comadj = sharpsl_param.comadj;
86 unsigned long flags;
88 local_irq_save(flags);
90 if (!locomolcd_dev) {
91 local_irq_restore(flags);
92 return;
95 /* read comadj */
96 if (comadj == -1 && machine_is_collie())
97 comadj = 128;
98 if (comadj == -1 && machine_is_poodle())
99 comadj = 118;
101 if (on)
102 locomolcd_on(comadj);
103 else
104 locomolcd_off(comadj);
106 local_irq_restore(flags);
108 EXPORT_SYMBOL(locomolcd_power);
111 static int current_intensity;
113 static int locomolcd_set_intensity(struct backlight_device *bd)
115 int intensity = bd->props.brightness;
117 if (bd->props.power != FB_BLANK_UNBLANK)
118 intensity = 0;
119 if (bd->props.fb_blank != FB_BLANK_UNBLANK)
120 intensity = 0;
121 if (locomolcd_flags & LOCOMOLCD_SUSPENDED)
122 intensity = 0;
124 switch (intensity) {
125 /* AC and non-AC are handled differently, but produce same results in sharp code? */
126 case 0: locomo_frontlight_set(locomolcd_dev, 0, 0, 161); break;
127 case 1: locomo_frontlight_set(locomolcd_dev, 117, 0, 161); break;
128 case 2: locomo_frontlight_set(locomolcd_dev, 163, 0, 148); break;
129 case 3: locomo_frontlight_set(locomolcd_dev, 194, 0, 161); break;
130 case 4: locomo_frontlight_set(locomolcd_dev, 194, 1, 161); break;
132 default:
133 return -ENODEV;
135 current_intensity = intensity;
136 return 0;
139 static int locomolcd_get_intensity(struct backlight_device *bd)
141 return current_intensity;
144 static const struct backlight_ops locomobl_data = {
145 .get_brightness = locomolcd_get_intensity,
146 .update_status = locomolcd_set_intensity,
149 #ifdef CONFIG_PM
150 static int locomolcd_suspend(struct locomo_dev *dev, pm_message_t state)
152 locomolcd_flags |= LOCOMOLCD_SUSPENDED;
153 locomolcd_set_intensity(locomolcd_bl_device);
154 return 0;
157 static int locomolcd_resume(struct locomo_dev *dev)
159 locomolcd_flags &= ~LOCOMOLCD_SUSPENDED;
160 locomolcd_set_intensity(locomolcd_bl_device);
161 return 0;
163 #else
164 #define locomolcd_suspend NULL
165 #define locomolcd_resume NULL
166 #endif
168 static int locomolcd_probe(struct locomo_dev *ldev)
170 struct backlight_properties props;
171 unsigned long flags;
173 local_irq_save(flags);
174 locomolcd_dev = ldev;
176 locomo_gpio_set_dir(ldev->dev.parent, LOCOMO_GPIO_FL_VR, 0);
178 /* the poodle_lcd_power function is called for the first time
179 * from fs_initcall, which is before locomo is activated.
180 * We need to recall poodle_lcd_power here*/
181 if (machine_is_poodle())
182 locomolcd_power(1);
184 local_irq_restore(flags);
186 memset(&props, 0, sizeof(struct backlight_properties));
187 props.max_brightness = 4;
188 locomolcd_bl_device = backlight_device_register("locomo-bl",
189 &ldev->dev, NULL,
190 &locomobl_data, &props);
192 if (IS_ERR (locomolcd_bl_device))
193 return PTR_ERR (locomolcd_bl_device);
195 /* Set up frontlight so that screen is readable */
196 locomolcd_bl_device->props.brightness = 2;
197 locomolcd_set_intensity(locomolcd_bl_device);
199 return 0;
202 static int locomolcd_remove(struct locomo_dev *dev)
204 unsigned long flags;
206 locomolcd_bl_device->props.brightness = 0;
207 locomolcd_bl_device->props.power = 0;
208 locomolcd_set_intensity(locomolcd_bl_device);
210 backlight_device_unregister(locomolcd_bl_device);
211 local_irq_save(flags);
212 locomolcd_dev = NULL;
213 local_irq_restore(flags);
214 return 0;
217 static struct locomo_driver poodle_lcd_driver = {
218 .drv = {
219 .name = "locomo-backlight",
221 .devid = LOCOMO_DEVID_BACKLIGHT,
222 .probe = locomolcd_probe,
223 .remove = locomolcd_remove,
224 .suspend = locomolcd_suspend,
225 .resume = locomolcd_resume,
229 static int __init locomolcd_init(void)
231 int ret = locomo_driver_register(&poodle_lcd_driver);
232 if (ret)
233 return ret;
235 #ifdef CONFIG_SA1100_COLLIE
236 sa1100fb_lcd_power = locomolcd_power;
237 #endif
238 return 0;
241 static void __exit locomolcd_exit(void)
243 locomo_driver_unregister(&poodle_lcd_driver);
246 module_init(locomolcd_init);
247 module_exit(locomolcd_exit);
249 MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>, Pavel Machek <pavel@suse.cz>");
250 MODULE_DESCRIPTION("Collie LCD driver");
251 MODULE_LICENSE("GPL");