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/kernel.h>
23#include <linux/init.h>
24#include <linux/platform_device.h>
25#include <linux/fb.h>
26#include <linux/backlight.h>
27#include <linux/slab.h>
28
29#include <mach/hardware.h>
30#include <plat/board.h>
31#include <plat/mux.h>
32
33#define OMAPBL_MAX_INTENSITY 0xff
34
35struct omap_backlight {
36 int powermode;
37 int current_intensity;
38
39 struct device *dev;
40 struct omap_backlight_config *pdata;
41};
42
43static void inline omapbl_send_intensity(int intensity)
44{
45 omap_writeb(intensity, OMAP_PWL_ENABLE);
46}
47
48static void inline omapbl_send_enable(int enable)
49{
50 omap_writeb(enable, OMAP_PWL_CLK_ENABLE);
51}
52
53static void omapbl_blank(struct omap_backlight *bl, int mode)
54{
55 if (bl->pdata->set_power)
56 bl->pdata->set_power(bl->dev, mode);
57
58 switch (mode) {
59 case FB_BLANK_NORMAL:
60 case FB_BLANK_VSYNC_SUSPEND:
61 case FB_BLANK_HSYNC_SUSPEND:
62 case FB_BLANK_POWERDOWN:
63 omapbl_send_intensity(0);
64 omapbl_send_enable(0);
65 break;
66
67 case FB_BLANK_UNBLANK:
68 omapbl_send_intensity(bl->current_intensity);
69 omapbl_send_enable(1);
70 break;
71 }
72}
73
74#ifdef CONFIG_PM
75static int omapbl_suspend(struct platform_device *pdev, pm_message_t state)
76{
77 struct backlight_device *dev = platform_get_drvdata(pdev);
78 struct omap_backlight *bl = dev_get_drvdata(&dev->dev);
79
80 omapbl_blank(bl, FB_BLANK_POWERDOWN);
81 return 0;
82}
83
84static int omapbl_resume(struct platform_device *pdev)
85{
86 struct backlight_device *dev = platform_get_drvdata(pdev);
87 struct omap_backlight *bl = dev_get_drvdata(&dev->dev);
88
89 omapbl_blank(bl, bl->powermode);
90 return 0;
91}
92#else
93#define omapbl_suspend NULL
94#define omapbl_resume NULL
95#endif
96
97static int omapbl_set_power(struct backlight_device *dev, int state)
98{
99 struct omap_backlight *bl = dev_get_drvdata(&dev->dev);
100
101 omapbl_blank(bl, state);
102 bl->powermode = state;
103
104 return 0;
105}
106
107static int omapbl_update_status(struct backlight_device *dev)
108{
109 struct omap_backlight *bl = dev_get_drvdata(&dev->dev);
110
111 if (bl->current_intensity != dev->props.brightness) {
112 if (bl->powermode == FB_BLANK_UNBLANK)
113 omapbl_send_intensity(dev->props.brightness);
114 bl->current_intensity = dev->props.brightness;
115 }
116
117 if (dev->props.fb_blank != bl->powermode)
118 omapbl_set_power(dev, dev->props.fb_blank);
119
120 return 0;
121}
122
123static int omapbl_get_intensity(struct backlight_device *dev)
124{
125 struct omap_backlight *bl = dev_get_drvdata(&dev->dev);
126 return bl->current_intensity;
127}
128
129static const struct backlight_ops omapbl_ops = {
130 .get_brightness = omapbl_get_intensity,
131 .update_status = omapbl_update_status,
132};
133
134static int omapbl_probe(struct platform_device *pdev)
135{
136 struct backlight_properties props;
137 struct backlight_device *dev;
138 struct omap_backlight *bl;
139 struct omap_backlight_config *pdata = pdev->dev.platform_data;
140
141 if (!pdata)
142 return -ENXIO;
143
144 bl = kzalloc(sizeof(struct omap_backlight), GFP_KERNEL);
145 if (unlikely(!bl))
146 return -ENOMEM;
147
148 memset(&props, 0, sizeof(struct backlight_properties));
149 props.type = BACKLIGHT_RAW;
150 props.max_brightness = OMAPBL_MAX_INTENSITY;
151 dev = backlight_device_register("omap-bl", &pdev->dev, bl, &omapbl_ops,
152 &props);
153 if (IS_ERR(dev)) {
154 kfree(bl);
155 return PTR_ERR(dev);
156 }
157
158 bl->powermode = FB_BLANK_POWERDOWN;
159 bl->current_intensity = 0;
160
161 bl->pdata = pdata;
162 bl->dev = &pdev->dev;
163
164 platform_set_drvdata(pdev, dev);
165
166 omap_cfg_reg(PWL);
167
168 dev->props.fb_blank = FB_BLANK_UNBLANK;
169 dev->props.brightness = pdata->default_intensity;
170 omapbl_update_status(dev);
171
172 printk(KERN_INFO "OMAP LCD backlight initialised\n");
173
174 return 0;
175}
176
177static int omapbl_remove(struct platform_device *pdev)
178{
179 struct backlight_device *dev = platform_get_drvdata(pdev);
180 struct omap_backlight *bl = dev_get_drvdata(&dev->dev);
181
182 backlight_device_unregister(dev);
183 kfree(bl);
184
185 return 0;
186}
187
188static struct platform_driver omapbl_driver = {
189 .probe = omapbl_probe,
190 .remove = omapbl_remove,
191 .suspend = omapbl_suspend,
192 .resume = omapbl_resume,
193 .driver = {
194 .name = "omap-bl",
195 },
196};
197
198static int __init omapbl_init(void)
199{
200 return platform_driver_register(&omapbl_driver);
201}
202
203static void __exit omapbl_exit(void)
204{
205 platform_driver_unregister(&omapbl_driver);
206}
207
208module_init(omapbl_init);
209module_exit(omapbl_exit);
210
211MODULE_AUTHOR("Andrzej Zaborowski <balrog@zabor.org>");
212MODULE_DESCRIPTION("OMAP LCD Backlight driver");
213MODULE_LICENSE("GPL");
214