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