Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * fbsysfs.c - framebuffer device class and attributes | |
3 | * | |
4 | * Copyright (c) 2004 James Simmons <jsimmons@infradead.org> | |
5 | * | |
6 | * This program is free software you can redistribute it and/or | |
7 | * modify it under the terms of the GNU General Public License | |
8 | * as published by the Free Software Foundation; either version | |
9 | * 2 of the License, or (at your option) any later version. | |
10 | */ | |
11 | ||
12 | /* | |
13 | * Note: currently there's only stubs for framebuffer_alloc and | |
14 | * framebuffer_release here. The reson for that is that until all drivers | |
15 | * are converted to use it a sysfsification will open OOPSable races. | |
16 | */ | |
17 | ||
18 | #include <linux/kernel.h> | |
5a0e3ad6 | 19 | #include <linux/slab.h> |
1da177e4 LT |
20 | #include <linux/fb.h> |
21 | #include <linux/console.h> | |
5474c120 | 22 | #include <linux/module.h> |
1da177e4 | 23 | |
1a6600be AD |
24 | #define FB_SYSFS_FLAG_ATTR 1 |
25 | ||
1da177e4 LT |
26 | /** |
27 | * framebuffer_alloc - creates a new frame buffer info structure | |
28 | * | |
29 | * @size: size of driver private data, can be zero | |
30 | * @dev: pointer to the device for this fb, this can be NULL | |
31 | * | |
32 | * Creates a new frame buffer info structure. Also reserves @size bytes | |
33 | * for driver private data (info->par). info->par (if any) will be | |
34 | * aligned to sizeof(long). | |
35 | * | |
25985edc | 36 | * Returns the new structure, or NULL if an error occurred. |
1da177e4 LT |
37 | * |
38 | */ | |
39 | struct fb_info *framebuffer_alloc(size_t size, struct device *dev) | |
40 | { | |
41 | #define BYTES_PER_LONG (BITS_PER_LONG/8) | |
42 | #define PADDING (BYTES_PER_LONG - (sizeof(struct fb_info) % BYTES_PER_LONG)) | |
43 | int fb_info_size = sizeof(struct fb_info); | |
44 | struct fb_info *info; | |
45 | char *p; | |
46 | ||
47 | if (size) | |
48 | fb_info_size += PADDING; | |
49 | ||
def1eded AD |
50 | p = kzalloc(fb_info_size + size, GFP_KERNEL); |
51 | ||
1da177e4 LT |
52 | if (!p) |
53 | return NULL; | |
def1eded | 54 | |
1da177e4 LT |
55 | info = (struct fb_info *) p; |
56 | ||
57 | if (size) | |
58 | info->par = p + fb_info_size; | |
59 | ||
60 | info->device = dev; | |
61 | ||
5474c120 | 62 | #ifdef CONFIG_FB_BACKLIGHT |
37ce69a5 | 63 | mutex_init(&info->bl_curve_mutex); |
5474c120 MH |
64 | #endif |
65 | ||
1da177e4 LT |
66 | return info; |
67 | #undef PADDING | |
68 | #undef BYTES_PER_LONG | |
69 | } | |
70 | EXPORT_SYMBOL(framebuffer_alloc); | |
71 | ||
72 | /** | |
73 | * framebuffer_release - marks the structure available for freeing | |
74 | * | |
75 | * @info: frame buffer info structure | |
76 | * | |
78cde088 | 77 | * Drop the reference count of the device embedded in the |
1da177e4 LT |
78 | * framebuffer info structure. |
79 | * | |
80 | */ | |
81 | void framebuffer_release(struct fb_info *info) | |
82 | { | |
cc440114 DC |
83 | if (!info) |
84 | return; | |
1471ca9a | 85 | kfree(info->apertures); |
1da177e4 LT |
86 | kfree(info); |
87 | } | |
88 | EXPORT_SYMBOL(framebuffer_release); | |
89 | ||
90 | static int activate(struct fb_info *fb_info, struct fb_var_screeninfo *var) | |
91 | { | |
92 | int err; | |
93 | ||
94 | var->activate |= FB_ACTIVATE_FORCE; | |
ac751efa | 95 | console_lock(); |
1da177e4 LT |
96 | fb_info->flags |= FBINFO_MISC_USEREVENT; |
97 | err = fb_set_var(fb_info, var); | |
98 | fb_info->flags &= ~FBINFO_MISC_USEREVENT; | |
ac751efa | 99 | console_unlock(); |
1da177e4 LT |
100 | if (err) |
101 | return err; | |
102 | return 0; | |
103 | } | |
104 | ||
105 | static int mode_string(char *buf, unsigned int offset, | |
106 | const struct fb_videomode *mode) | |
107 | { | |
108 | char m = 'U'; | |
9dac73a4 DT |
109 | char v = 'p'; |
110 | ||
1da177e4 LT |
111 | if (mode->flag & FB_MODE_IS_DETAILED) |
112 | m = 'D'; | |
113 | if (mode->flag & FB_MODE_IS_VESA) | |
114 | m = 'V'; | |
115 | if (mode->flag & FB_MODE_IS_STANDARD) | |
116 | m = 'S'; | |
9dac73a4 DT |
117 | |
118 | if (mode->vmode & FB_VMODE_INTERLACED) | |
119 | v = 'i'; | |
120 | if (mode->vmode & FB_VMODE_DOUBLE) | |
121 | v = 'd'; | |
122 | ||
123 | return snprintf(&buf[offset], PAGE_SIZE - offset, "%c:%dx%d%c-%d\n", | |
124 | m, mode->xres, mode->yres, v, mode->refresh); | |
1da177e4 LT |
125 | } |
126 | ||
78cde088 GKH |
127 | static ssize_t store_mode(struct device *device, struct device_attribute *attr, |
128 | const char *buf, size_t count) | |
1da177e4 | 129 | { |
78cde088 | 130 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
131 | char mstr[100]; |
132 | struct fb_var_screeninfo var; | |
133 | struct fb_modelist *modelist; | |
134 | struct fb_videomode *mode; | |
135 | struct list_head *pos; | |
136 | size_t i; | |
137 | int err; | |
138 | ||
139 | memset(&var, 0, sizeof(var)); | |
140 | ||
141 | list_for_each(pos, &fb_info->modelist) { | |
142 | modelist = list_entry(pos, struct fb_modelist, list); | |
143 | mode = &modelist->mode; | |
144 | i = mode_string(mstr, 0, mode); | |
145 | if (strncmp(mstr, buf, max(count, i)) == 0) { | |
146 | ||
147 | var = fb_info->var; | |
148 | fb_videomode_to_var(&var, mode); | |
149 | if ((err = activate(fb_info, &var))) | |
150 | return err; | |
151 | fb_info->mode = mode; | |
152 | return count; | |
153 | } | |
154 | } | |
155 | return -EINVAL; | |
156 | } | |
157 | ||
78cde088 GKH |
158 | static ssize_t show_mode(struct device *device, struct device_attribute *attr, |
159 | char *buf) | |
1da177e4 | 160 | { |
78cde088 | 161 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
162 | |
163 | if (!fb_info->mode) | |
164 | return 0; | |
165 | ||
166 | return mode_string(buf, 0, fb_info->mode); | |
167 | } | |
168 | ||
78cde088 GKH |
169 | static ssize_t store_modes(struct device *device, |
170 | struct device_attribute *attr, | |
171 | const char *buf, size_t count) | |
1da177e4 | 172 | { |
78cde088 | 173 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
174 | LIST_HEAD(old_list); |
175 | int i = count / sizeof(struct fb_videomode); | |
176 | ||
177 | if (i * sizeof(struct fb_videomode) != count) | |
178 | return -EINVAL; | |
179 | ||
ac751efa | 180 | console_lock(); |
1da177e4 | 181 | list_splice(&fb_info->modelist, &old_list); |
9791d763 | 182 | fb_videomode_to_modelist((const struct fb_videomode *)buf, i, |
1da177e4 LT |
183 | &fb_info->modelist); |
184 | if (fb_new_modelist(fb_info)) { | |
185 | fb_destroy_modelist(&fb_info->modelist); | |
186 | list_splice(&old_list, &fb_info->modelist); | |
187 | } else | |
188 | fb_destroy_modelist(&old_list); | |
189 | ||
ac751efa | 190 | console_unlock(); |
1da177e4 LT |
191 | |
192 | return 0; | |
193 | } | |
194 | ||
78cde088 GKH |
195 | static ssize_t show_modes(struct device *device, struct device_attribute *attr, |
196 | char *buf) | |
1da177e4 | 197 | { |
78cde088 | 198 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
199 | unsigned int i; |
200 | struct list_head *pos; | |
201 | struct fb_modelist *modelist; | |
202 | const struct fb_videomode *mode; | |
203 | ||
204 | i = 0; | |
205 | list_for_each(pos, &fb_info->modelist) { | |
206 | modelist = list_entry(pos, struct fb_modelist, list); | |
207 | mode = &modelist->mode; | |
208 | i += mode_string(buf, i, mode); | |
209 | } | |
210 | return i; | |
211 | } | |
212 | ||
78cde088 GKH |
213 | static ssize_t store_bpp(struct device *device, struct device_attribute *attr, |
214 | const char *buf, size_t count) | |
1da177e4 | 215 | { |
78cde088 | 216 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
217 | struct fb_var_screeninfo var; |
218 | char ** last = NULL; | |
219 | int err; | |
220 | ||
221 | var = fb_info->var; | |
222 | var.bits_per_pixel = simple_strtoul(buf, last, 0); | |
223 | if ((err = activate(fb_info, &var))) | |
224 | return err; | |
225 | return count; | |
226 | } | |
227 | ||
78cde088 GKH |
228 | static ssize_t show_bpp(struct device *device, struct device_attribute *attr, |
229 | char *buf) | |
1da177e4 | 230 | { |
78cde088 | 231 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
232 | return snprintf(buf, PAGE_SIZE, "%d\n", fb_info->var.bits_per_pixel); |
233 | } | |
234 | ||
78cde088 GKH |
235 | static ssize_t store_rotate(struct device *device, |
236 | struct device_attribute *attr, | |
237 | const char *buf, size_t count) | |
a812c94b | 238 | { |
78cde088 | 239 | struct fb_info *fb_info = dev_get_drvdata(device); |
a812c94b AD |
240 | struct fb_var_screeninfo var; |
241 | char **last = NULL; | |
242 | int err; | |
243 | ||
244 | var = fb_info->var; | |
245 | var.rotate = simple_strtoul(buf, last, 0); | |
246 | ||
247 | if ((err = activate(fb_info, &var))) | |
248 | return err; | |
249 | ||
250 | return count; | |
251 | } | |
252 | ||
253 | ||
78cde088 GKH |
254 | static ssize_t show_rotate(struct device *device, |
255 | struct device_attribute *attr, char *buf) | |
a812c94b | 256 | { |
78cde088 | 257 | struct fb_info *fb_info = dev_get_drvdata(device); |
a812c94b AD |
258 | |
259 | return snprintf(buf, PAGE_SIZE, "%d\n", fb_info->var.rotate); | |
260 | } | |
261 | ||
78cde088 GKH |
262 | static ssize_t store_virtual(struct device *device, |
263 | struct device_attribute *attr, | |
264 | const char *buf, size_t count) | |
1da177e4 | 265 | { |
78cde088 | 266 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
267 | struct fb_var_screeninfo var; |
268 | char *last = NULL; | |
269 | int err; | |
270 | ||
271 | var = fb_info->var; | |
272 | var.xres_virtual = simple_strtoul(buf, &last, 0); | |
273 | last++; | |
274 | if (last - buf >= count) | |
275 | return -EINVAL; | |
276 | var.yres_virtual = simple_strtoul(last, &last, 0); | |
1da177e4 LT |
277 | |
278 | if ((err = activate(fb_info, &var))) | |
279 | return err; | |
280 | return count; | |
281 | } | |
282 | ||
78cde088 GKH |
283 | static ssize_t show_virtual(struct device *device, |
284 | struct device_attribute *attr, char *buf) | |
1da177e4 | 285 | { |
78cde088 | 286 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 | 287 | return snprintf(buf, PAGE_SIZE, "%d,%d\n", fb_info->var.xres_virtual, |
e2c16499 | 288 | fb_info->var.yres_virtual); |
1da177e4 LT |
289 | } |
290 | ||
78cde088 GKH |
291 | static ssize_t show_stride(struct device *device, |
292 | struct device_attribute *attr, char *buf) | |
c14e2cfc | 293 | { |
78cde088 | 294 | struct fb_info *fb_info = dev_get_drvdata(device); |
c14e2cfc JS |
295 | return snprintf(buf, PAGE_SIZE, "%d\n", fb_info->fix.line_length); |
296 | } | |
297 | ||
78cde088 GKH |
298 | static ssize_t store_blank(struct device *device, |
299 | struct device_attribute *attr, | |
300 | const char *buf, size_t count) | |
1da177e4 | 301 | { |
78cde088 | 302 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
303 | char *last = NULL; |
304 | int err; | |
305 | ||
ac751efa | 306 | console_lock(); |
1da177e4 LT |
307 | fb_info->flags |= FBINFO_MISC_USEREVENT; |
308 | err = fb_blank(fb_info, simple_strtoul(buf, &last, 0)); | |
309 | fb_info->flags &= ~FBINFO_MISC_USEREVENT; | |
ac751efa | 310 | console_unlock(); |
1da177e4 LT |
311 | if (err < 0) |
312 | return err; | |
313 | return count; | |
314 | } | |
315 | ||
78cde088 GKH |
316 | static ssize_t show_blank(struct device *device, |
317 | struct device_attribute *attr, char *buf) | |
1da177e4 | 318 | { |
78cde088 | 319 | // struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
320 | return 0; |
321 | } | |
322 | ||
78cde088 GKH |
323 | static ssize_t store_console(struct device *device, |
324 | struct device_attribute *attr, | |
325 | const char *buf, size_t count) | |
1da177e4 | 326 | { |
78cde088 | 327 | // struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
328 | return 0; |
329 | } | |
330 | ||
78cde088 GKH |
331 | static ssize_t show_console(struct device *device, |
332 | struct device_attribute *attr, char *buf) | |
1da177e4 | 333 | { |
78cde088 | 334 | // struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
335 | return 0; |
336 | } | |
337 | ||
78cde088 GKH |
338 | static ssize_t store_cursor(struct device *device, |
339 | struct device_attribute *attr, | |
340 | const char *buf, size_t count) | |
1da177e4 | 341 | { |
78cde088 | 342 | // struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
343 | return 0; |
344 | } | |
345 | ||
78cde088 GKH |
346 | static ssize_t show_cursor(struct device *device, |
347 | struct device_attribute *attr, char *buf) | |
1da177e4 | 348 | { |
78cde088 | 349 | // struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
350 | return 0; |
351 | } | |
352 | ||
78cde088 GKH |
353 | static ssize_t store_pan(struct device *device, |
354 | struct device_attribute *attr, | |
355 | const char *buf, size_t count) | |
1da177e4 | 356 | { |
78cde088 | 357 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 LT |
358 | struct fb_var_screeninfo var; |
359 | char *last = NULL; | |
360 | int err; | |
361 | ||
362 | var = fb_info->var; | |
363 | var.xoffset = simple_strtoul(buf, &last, 0); | |
364 | last++; | |
365 | if (last - buf >= count) | |
366 | return -EINVAL; | |
367 | var.yoffset = simple_strtoul(last, &last, 0); | |
368 | ||
ac751efa | 369 | console_lock(); |
1da177e4 | 370 | err = fb_pan_display(fb_info, &var); |
ac751efa | 371 | console_unlock(); |
1da177e4 LT |
372 | |
373 | if (err < 0) | |
374 | return err; | |
375 | return count; | |
376 | } | |
377 | ||
78cde088 GKH |
378 | static ssize_t show_pan(struct device *device, |
379 | struct device_attribute *attr, char *buf) | |
1da177e4 | 380 | { |
78cde088 | 381 | struct fb_info *fb_info = dev_get_drvdata(device); |
1da177e4 | 382 | return snprintf(buf, PAGE_SIZE, "%d,%d\n", fb_info->var.xoffset, |
c4270637 | 383 | fb_info->var.yoffset); |
1da177e4 LT |
384 | } |
385 | ||
78cde088 GKH |
386 | static ssize_t show_name(struct device *device, |
387 | struct device_attribute *attr, char *buf) | |
02459eaa | 388 | { |
78cde088 | 389 | struct fb_info *fb_info = dev_get_drvdata(device); |
02459eaa JS |
390 | |
391 | return snprintf(buf, PAGE_SIZE, "%s\n", fb_info->fix.id); | |
392 | } | |
393 | ||
78cde088 GKH |
394 | static ssize_t store_fbstate(struct device *device, |
395 | struct device_attribute *attr, | |
396 | const char *buf, size_t count) | |
30420f8f | 397 | { |
78cde088 | 398 | struct fb_info *fb_info = dev_get_drvdata(device); |
30420f8f MG |
399 | u32 state; |
400 | char *last = NULL; | |
401 | ||
402 | state = simple_strtoul(buf, &last, 0); | |
403 | ||
9e769ff3 HRK |
404 | if (!lock_fb_info(fb_info)) |
405 | return -ENODEV; | |
ac751efa | 406 | console_lock(); |
30420f8f | 407 | fb_set_suspend(fb_info, (int)state); |
ac751efa | 408 | console_unlock(); |
9e769ff3 | 409 | unlock_fb_info(fb_info); |
30420f8f MG |
410 | |
411 | return count; | |
412 | } | |
413 | ||
78cde088 GKH |
414 | static ssize_t show_fbstate(struct device *device, |
415 | struct device_attribute *attr, char *buf) | |
30420f8f | 416 | { |
78cde088 | 417 | struct fb_info *fb_info = dev_get_drvdata(device); |
30420f8f MG |
418 | return snprintf(buf, PAGE_SIZE, "%d\n", fb_info->state); |
419 | } | |
420 | ||
5474c120 | 421 | #ifdef CONFIG_FB_BACKLIGHT |
78cde088 GKH |
422 | static ssize_t store_bl_curve(struct device *device, |
423 | struct device_attribute *attr, | |
424 | const char *buf, size_t count) | |
5474c120 | 425 | { |
78cde088 | 426 | struct fb_info *fb_info = dev_get_drvdata(device); |
5474c120 MH |
427 | u8 tmp_curve[FB_BACKLIGHT_LEVELS]; |
428 | unsigned int i; | |
429 | ||
25981de5 MH |
430 | /* Some drivers don't use framebuffer_alloc(), but those also |
431 | * don't have backlights. | |
432 | */ | |
433 | if (!fb_info || !fb_info->bl_dev) | |
434 | return -ENODEV; | |
435 | ||
5474c120 MH |
436 | if (count != (FB_BACKLIGHT_LEVELS / 8 * 24)) |
437 | return -EINVAL; | |
438 | ||
439 | for (i = 0; i < (FB_BACKLIGHT_LEVELS / 8); ++i) | |
440 | if (sscanf(&buf[i * 24], | |
441 | "%2hhx %2hhx %2hhx %2hhx %2hhx %2hhx %2hhx %2hhx\n", | |
442 | &tmp_curve[i * 8 + 0], | |
443 | &tmp_curve[i * 8 + 1], | |
444 | &tmp_curve[i * 8 + 2], | |
445 | &tmp_curve[i * 8 + 3], | |
446 | &tmp_curve[i * 8 + 4], | |
447 | &tmp_curve[i * 8 + 5], | |
448 | &tmp_curve[i * 8 + 6], | |
449 | &tmp_curve[i * 8 + 7]) != 8) | |
450 | return -EINVAL; | |
451 | ||
452 | /* If there has been an error in the input data, we won't | |
453 | * reach this loop. | |
454 | */ | |
37ce69a5 | 455 | mutex_lock(&fb_info->bl_curve_mutex); |
5474c120 MH |
456 | for (i = 0; i < FB_BACKLIGHT_LEVELS; ++i) |
457 | fb_info->bl_curve[i] = tmp_curve[i]; | |
37ce69a5 | 458 | mutex_unlock(&fb_info->bl_curve_mutex); |
5474c120 MH |
459 | |
460 | return count; | |
461 | } | |
462 | ||
78cde088 GKH |
463 | static ssize_t show_bl_curve(struct device *device, |
464 | struct device_attribute *attr, char *buf) | |
5474c120 | 465 | { |
78cde088 | 466 | struct fb_info *fb_info = dev_get_drvdata(device); |
5474c120 MH |
467 | ssize_t len = 0; |
468 | unsigned int i; | |
469 | ||
25981de5 MH |
470 | /* Some drivers don't use framebuffer_alloc(), but those also |
471 | * don't have backlights. | |
472 | */ | |
473 | if (!fb_info || !fb_info->bl_dev) | |
474 | return -ENODEV; | |
475 | ||
37ce69a5 | 476 | mutex_lock(&fb_info->bl_curve_mutex); |
5474c120 MH |
477 | for (i = 0; i < FB_BACKLIGHT_LEVELS; i += 8) |
478 | len += snprintf(&buf[len], PAGE_SIZE, | |
479 | "%02x %02x %02x %02x %02x %02x %02x %02x\n", | |
480 | fb_info->bl_curve[i + 0], | |
481 | fb_info->bl_curve[i + 1], | |
482 | fb_info->bl_curve[i + 2], | |
483 | fb_info->bl_curve[i + 3], | |
484 | fb_info->bl_curve[i + 4], | |
485 | fb_info->bl_curve[i + 5], | |
486 | fb_info->bl_curve[i + 6], | |
487 | fb_info->bl_curve[i + 7]); | |
37ce69a5 | 488 | mutex_unlock(&fb_info->bl_curve_mutex); |
5474c120 MH |
489 | |
490 | return len; | |
491 | } | |
492 | #endif | |
493 | ||
913e7ec5 JS |
494 | /* When cmap is added back in it should be a binary attribute |
495 | * not a text one. Consideration should also be given to converting | |
496 | * fbdev to use configfs instead of sysfs */ | |
78cde088 | 497 | static struct device_attribute device_attrs[] = { |
1da177e4 LT |
498 | __ATTR(bits_per_pixel, S_IRUGO|S_IWUSR, show_bpp, store_bpp), |
499 | __ATTR(blank, S_IRUGO|S_IWUSR, show_blank, store_blank), | |
1da177e4 LT |
500 | __ATTR(console, S_IRUGO|S_IWUSR, show_console, store_console), |
501 | __ATTR(cursor, S_IRUGO|S_IWUSR, show_cursor, store_cursor), | |
502 | __ATTR(mode, S_IRUGO|S_IWUSR, show_mode, store_mode), | |
503 | __ATTR(modes, S_IRUGO|S_IWUSR, show_modes, store_modes), | |
504 | __ATTR(pan, S_IRUGO|S_IWUSR, show_pan, store_pan), | |
505 | __ATTR(virtual_size, S_IRUGO|S_IWUSR, show_virtual, store_virtual), | |
02459eaa | 506 | __ATTR(name, S_IRUGO, show_name, NULL), |
c14e2cfc | 507 | __ATTR(stride, S_IRUGO, show_stride, NULL), |
a812c94b | 508 | __ATTR(rotate, S_IRUGO|S_IWUSR, show_rotate, store_rotate), |
30420f8f | 509 | __ATTR(state, S_IRUGO|S_IWUSR, show_fbstate, store_fbstate), |
5474c120 MH |
510 | #ifdef CONFIG_FB_BACKLIGHT |
511 | __ATTR(bl_curve, S_IRUGO|S_IWUSR, show_bl_curve, store_bl_curve), | |
512 | #endif | |
1da177e4 LT |
513 | }; |
514 | ||
78cde088 | 515 | int fb_init_device(struct fb_info *fb_info) |
1da177e4 | 516 | { |
1a6600be AD |
517 | int i, error = 0; |
518 | ||
78cde088 | 519 | dev_set_drvdata(fb_info->dev, fb_info); |
1da177e4 | 520 | |
1a6600be AD |
521 | fb_info->class_flag |= FB_SYSFS_FLAG_ATTR; |
522 | ||
78cde088 GKH |
523 | for (i = 0; i < ARRAY_SIZE(device_attrs); i++) { |
524 | error = device_create_file(fb_info->dev, &device_attrs[i]); | |
1a6600be AD |
525 | |
526 | if (error) | |
527 | break; | |
528 | } | |
529 | ||
530 | if (error) { | |
531 | while (--i >= 0) | |
78cde088 | 532 | device_remove_file(fb_info->dev, &device_attrs[i]); |
1a6600be AD |
533 | fb_info->class_flag &= ~FB_SYSFS_FLAG_ATTR; |
534 | } | |
535 | ||
1da177e4 LT |
536 | return 0; |
537 | } | |
538 | ||
78cde088 | 539 | void fb_cleanup_device(struct fb_info *fb_info) |
1da177e4 LT |
540 | { |
541 | unsigned int i; | |
542 | ||
1a6600be | 543 | if (fb_info->class_flag & FB_SYSFS_FLAG_ATTR) { |
78cde088 GKH |
544 | for (i = 0; i < ARRAY_SIZE(device_attrs); i++) |
545 | device_remove_file(fb_info->dev, &device_attrs[i]); | |
1a6600be AD |
546 | |
547 | fb_info->class_flag &= ~FB_SYSFS_FLAG_ATTR; | |
548 | } | |
1da177e4 LT |
549 | } |
550 | ||
5474c120 MH |
551 | #ifdef CONFIG_FB_BACKLIGHT |
552 | /* This function generates a linear backlight curve | |
553 | * | |
554 | * 0: off | |
555 | * 1-7: min | |
556 | * 8-127: linear from min to max | |
557 | */ | |
558 | void fb_bl_default_curve(struct fb_info *fb_info, u8 off, u8 min, u8 max) | |
559 | { | |
560 | unsigned int i, flat, count, range = (max - min); | |
561 | ||
37ce69a5 RP |
562 | mutex_lock(&fb_info->bl_curve_mutex); |
563 | ||
5474c120 | 564 | fb_info->bl_curve[0] = off; |
1da177e4 | 565 | |
5474c120 MH |
566 | for (flat = 1; flat < (FB_BACKLIGHT_LEVELS / 16); ++flat) |
567 | fb_info->bl_curve[flat] = min; | |
568 | ||
569 | count = FB_BACKLIGHT_LEVELS * 15 / 16; | |
570 | for (i = 0; i < count; ++i) | |
571 | fb_info->bl_curve[flat + i] = min + (range * (i + 1) / count); | |
37ce69a5 RP |
572 | |
573 | mutex_unlock(&fb_info->bl_curve_mutex); | |
5474c120 MH |
574 | } |
575 | EXPORT_SYMBOL_GPL(fb_bl_default_curve); | |
576 | #endif |