2 * Backlight control code for Sharp Zaurus SL-5500
4 * Copyright 2005 John Lenz <lenz@cs.wisc.edu>
5 * Maintainer: Pavel Machek <pavel@ucw.cz> (unless John wants to :-)
8 * This driver assumes single CPU. That's okay, because collie is
9 * slightly old hardware, and no one is going to retrofit second CPU to
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>
20 #include <linux/backlight.h>
22 #include <asm/hardware/locomo.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);
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);
44 locomo_m62332_senddata(locomolcd_dev
, comadj
, 0);
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);
51 /* TFTCRST | CPSOUT=0 | CPSEN */
52 locomo_writel(0x01, locomolcd_dev
->mapbase
+ LOCOMO_TC
);
55 locomo_writel(6, locomolcd_dev
->mapbase
+ LOCOMO_CPSD
);
57 /* TFTCRST | CPSOUT=0 | CPSEN */
58 locomo_writel((0x04 | 0x01), locomolcd_dev
->mapbase
+ LOCOMO_TC
);
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
);
71 locomo_gpio_write(locomolcd_dev
->dev
.parent
, LOCOMO_GPIO_LCD_VSHA_ON
, 0);
74 locomo_gpio_write(locomolcd_dev
->dev
.parent
, LOCOMO_GPIO_LCD_VEE_ON
, 0);
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
;
88 local_irq_save(flags
);
91 local_irq_restore(flags
);
96 if (comadj
== -1 && machine_is_collie())
98 if (comadj
== -1 && machine_is_poodle())
102 locomolcd_on(comadj
);
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
)
119 if (bd
->props
.fb_blank
!= FB_BLANK_UNBLANK
)
121 if (locomolcd_flags
& LOCOMOLCD_SUSPENDED
)
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;
135 current_intensity
= intensity
;
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
,
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
);
157 static int locomolcd_resume(struct locomo_dev
*dev
)
159 locomolcd_flags
&= ~LOCOMOLCD_SUSPENDED
;
160 locomolcd_set_intensity(locomolcd_bl_device
);
164 #define locomolcd_suspend NULL
165 #define locomolcd_resume NULL
168 static int locomolcd_probe(struct locomo_dev
*ldev
)
170 struct backlight_properties props
;
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())
184 local_irq_restore(flags
);
186 memset(&props
, 0, sizeof(struct backlight_properties
));
187 props
.type
= BACKLIGHT_RAW
;
188 props
.max_brightness
= 4;
189 locomolcd_bl_device
= backlight_device_register("locomo-bl",
191 &locomobl_data
, &props
);
193 if (IS_ERR (locomolcd_bl_device
))
194 return PTR_ERR (locomolcd_bl_device
);
196 /* Set up frontlight so that screen is readable */
197 locomolcd_bl_device
->props
.brightness
= 2;
198 locomolcd_set_intensity(locomolcd_bl_device
);
203 static int locomolcd_remove(struct locomo_dev
*dev
)
207 locomolcd_bl_device
->props
.brightness
= 0;
208 locomolcd_bl_device
->props
.power
= 0;
209 locomolcd_set_intensity(locomolcd_bl_device
);
211 backlight_device_unregister(locomolcd_bl_device
);
212 local_irq_save(flags
);
213 locomolcd_dev
= NULL
;
214 local_irq_restore(flags
);
218 static struct locomo_driver poodle_lcd_driver
= {
220 .name
= "locomo-backlight",
222 .devid
= LOCOMO_DEVID_BACKLIGHT
,
223 .probe
= locomolcd_probe
,
224 .remove
= locomolcd_remove
,
225 .suspend
= locomolcd_suspend
,
226 .resume
= locomolcd_resume
,
230 static int __init
locomolcd_init(void)
232 int ret
= locomo_driver_register(&poodle_lcd_driver
);
236 #ifdef CONFIG_SA1100_COLLIE
237 sa1100fb_lcd_power
= locomolcd_power
;
242 static void __exit
locomolcd_exit(void)
244 locomo_driver_unregister(&poodle_lcd_driver
);
247 module_init(locomolcd_init
);
248 module_exit(locomolcd_exit
);
250 MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>, Pavel Machek <pavel@ucw.cz>");
251 MODULE_DESCRIPTION("Collie LCD driver");
252 MODULE_LICENSE("GPL");