[PATCH] fbdev: Fix greater than 1 bit monochrome color handling
[pandora-kernel.git] / drivers / video / fbmem.c
1 /*
2  *  linux/drivers/video/fbmem.c
3  *
4  *  Copyright (C) 1994 Martin Schaller
5  *
6  *      2001 - Documented with DocBook
7  *      - Brad Douglas <brad@neruo.com>
8  *
9  * This file is subject to the terms and conditions of the GNU General Public
10  * License.  See the file COPYING in the main directory of this archive
11  * for more details.
12  */
13
14 #include <linux/config.h>
15 #include <linux/module.h>
16
17 #include <linux/types.h>
18 #include <linux/errno.h>
19 #include <linux/sched.h>
20 #include <linux/smp_lock.h>
21 #include <linux/kernel.h>
22 #include <linux/major.h>
23 #include <linux/slab.h>
24 #include <linux/mm.h>
25 #include <linux/mman.h>
26 #include <linux/tty.h>
27 #include <linux/init.h>
28 #include <linux/linux_logo.h>
29 #include <linux/proc_fs.h>
30 #include <linux/console.h>
31 #ifdef CONFIG_KMOD
32 #include <linux/kmod.h>
33 #endif
34 #include <linux/devfs_fs_kernel.h>
35 #include <linux/err.h>
36 #include <linux/kernel.h>
37 #include <linux/device.h>
38 #include <linux/efi.h>
39
40 #if defined(__mc68000__) || defined(CONFIG_APUS)
41 #include <asm/setup.h>
42 #endif
43
44 #include <asm/io.h>
45 #include <asm/uaccess.h>
46 #include <asm/page.h>
47 #include <asm/pgtable.h>
48
49 #include <linux/fb.h>
50
51     /*
52      *  Frame buffer device initialization and setup routines
53      */
54
55 #define FBPIXMAPSIZE    (1024 * 8)
56
57 static struct notifier_block *fb_notifier_list;
58 struct fb_info *registered_fb[FB_MAX];
59 int num_registered_fb;
60
61 /*
62  * Helpers
63  */
64
65 int fb_get_color_depth(struct fb_var_screeninfo *var,
66                        struct fb_fix_screeninfo *fix)
67 {
68         int depth = 0;
69
70         if (fix->visual == FB_VISUAL_MONO01 ||
71             fix->visual == FB_VISUAL_MONO10)
72                 depth = 1;
73         else {
74                 if (var->green.length == var->blue.length &&
75                     var->green.length == var->red.length &&
76                     var->green.offset == var->blue.offset &&
77                     var->green.offset == var->red.offset)
78                         depth = var->green.length;
79                 else
80                         depth = var->green.length + var->red.length +
81                                 var->blue.length;
82         }
83
84         return depth;
85 }
86 EXPORT_SYMBOL(fb_get_color_depth);
87
88 /*
89  * Data padding functions.
90  */
91 void fb_pad_aligned_buffer(u8 *dst, u32 d_pitch, u8 *src, u32 s_pitch, u32 height)
92 {
93         int i, j;
94
95         for (i = height; i--; ) {
96                 /* s_pitch is a few bytes at the most, memcpy is suboptimal */
97                 for (j = 0; j < s_pitch; j++)
98                         dst[j] = src[j];
99                 src += s_pitch;
100                 dst += d_pitch;
101         }
102 }
103 EXPORT_SYMBOL(fb_pad_aligned_buffer);
104
105 void fb_pad_unaligned_buffer(u8 *dst, u32 d_pitch, u8 *src, u32 idx, u32 height,
106                                 u32 shift_high, u32 shift_low, u32 mod)
107 {
108         u8 mask = (u8) (0xfff << shift_high), tmp;
109         int i, j;
110
111         for (i = height; i--; ) {
112                 for (j = 0; j < idx; j++) {
113                         tmp = dst[j];
114                         tmp &= mask;
115                         tmp |= *src >> shift_low;
116                         dst[j] = tmp;
117                         tmp = *src << shift_high;
118                         dst[j+1] = tmp;
119                         src++;
120                 }
121                 tmp = dst[idx];
122                 tmp &= mask;
123                 tmp |= *src >> shift_low;
124                 dst[idx] = tmp;
125                 if (shift_high < mod) {
126                         tmp = *src << shift_high;
127                         dst[idx+1] = tmp;
128                 }
129                 src++;
130                 dst += d_pitch;
131         }
132 }
133 EXPORT_SYMBOL(fb_pad_unaligned_buffer);
134
135 /*
136  * we need to lock this section since fb_cursor
137  * may use fb_imageblit()
138  */
139 char* fb_get_buffer_offset(struct fb_info *info, struct fb_pixmap *buf, u32 size)
140 {
141         u32 align = buf->buf_align - 1, offset;
142         char *addr = buf->addr;
143
144         /* If IO mapped, we need to sync before access, no sharing of
145          * the pixmap is done
146          */
147         if (buf->flags & FB_PIXMAP_IO) {
148                 if (info->fbops->fb_sync && (buf->flags & FB_PIXMAP_SYNC))
149                         info->fbops->fb_sync(info);
150                 return addr;
151         }
152
153         /* See if we fit in the remaining pixmap space */
154         offset = buf->offset + align;
155         offset &= ~align;
156         if (offset + size > buf->size) {
157                 /* We do not fit. In order to be able to re-use the buffer,
158                  * we must ensure no asynchronous DMA'ing or whatever operation
159                  * is in progress, we sync for that.
160                  */
161                 if (info->fbops->fb_sync && (buf->flags & FB_PIXMAP_SYNC))
162                         info->fbops->fb_sync(info);
163                 offset = 0;
164         }
165         buf->offset = offset + size;
166         addr += offset;
167
168         return addr;
169 }
170
171 #ifdef CONFIG_LOGO
172 #include <linux/linux_logo.h>
173
174 static inline unsigned safe_shift(unsigned d, int n)
175 {
176         return n < 0 ? d >> -n : d << n;
177 }
178
179 static void fb_set_logocmap(struct fb_info *info,
180                                    const struct linux_logo *logo)
181 {
182         struct fb_cmap palette_cmap;
183         u16 palette_green[16];
184         u16 palette_blue[16];
185         u16 palette_red[16];
186         int i, j, n;
187         const unsigned char *clut = logo->clut;
188
189         palette_cmap.start = 0;
190         palette_cmap.len = 16;
191         palette_cmap.red = palette_red;
192         palette_cmap.green = palette_green;
193         palette_cmap.blue = palette_blue;
194         palette_cmap.transp = NULL;
195
196         for (i = 0; i < logo->clutsize; i += n) {
197                 n = logo->clutsize - i;
198                 /* palette_cmap provides space for only 16 colors at once */
199                 if (n > 16)
200                         n = 16;
201                 palette_cmap.start = 32 + i;
202                 palette_cmap.len = n;
203                 for (j = 0; j < n; ++j) {
204                         palette_cmap.red[j] = clut[0] << 8 | clut[0];
205                         palette_cmap.green[j] = clut[1] << 8 | clut[1];
206                         palette_cmap.blue[j] = clut[2] << 8 | clut[2];
207                         clut += 3;
208                 }
209                 fb_set_cmap(&palette_cmap, info);
210         }
211 }
212
213 static void  fb_set_logo_truepalette(struct fb_info *info,
214                                             const struct linux_logo *logo,
215                                             u32 *palette)
216 {
217         unsigned char mask[9] = { 0,0x80,0xc0,0xe0,0xf0,0xf8,0xfc,0xfe,0xff };
218         unsigned char redmask, greenmask, bluemask;
219         int redshift, greenshift, blueshift;
220         int i;
221         const unsigned char *clut = logo->clut;
222
223         /*
224          * We have to create a temporary palette since console palette is only
225          * 16 colors long.
226          */
227         /* Bug: Doesn't obey msb_right ... (who needs that?) */
228         redmask   = mask[info->var.red.length   < 8 ? info->var.red.length   : 8];
229         greenmask = mask[info->var.green.length < 8 ? info->var.green.length : 8];
230         bluemask  = mask[info->var.blue.length  < 8 ? info->var.blue.length  : 8];
231         redshift   = info->var.red.offset   - (8 - info->var.red.length);
232         greenshift = info->var.green.offset - (8 - info->var.green.length);
233         blueshift  = info->var.blue.offset  - (8 - info->var.blue.length);
234
235         for ( i = 0; i < logo->clutsize; i++) {
236                 palette[i+32] = (safe_shift((clut[0] & redmask), redshift) |
237                                  safe_shift((clut[1] & greenmask), greenshift) |
238                                  safe_shift((clut[2] & bluemask), blueshift));
239                 clut += 3;
240         }
241 }
242
243 static void fb_set_logo_directpalette(struct fb_info *info,
244                                              const struct linux_logo *logo,
245                                              u32 *palette)
246 {
247         int redshift, greenshift, blueshift;
248         int i;
249
250         redshift = info->var.red.offset;
251         greenshift = info->var.green.offset;
252         blueshift = info->var.blue.offset;
253
254         for (i = 32; i < logo->clutsize; i++)
255                 palette[i] = i << redshift | i << greenshift | i << blueshift;
256 }
257
258 static void fb_set_logo(struct fb_info *info,
259                                const struct linux_logo *logo, u8 *dst,
260                                int depth)
261 {
262         int i, j, k;
263         const u8 *src = logo->data;
264         u8 xor = (info->fix.visual == FB_VISUAL_MONO01) ? 0xff : 0;
265         u8 fg = 1, d;
266
267         if (fb_get_color_depth(&info->var, &info->fix) == 3)
268                 fg = 7;
269
270         if (info->fix.visual == FB_VISUAL_MONO01 ||
271             info->fix.visual == FB_VISUAL_MONO10)
272                 fg = ~((u8) (0xfff << info->var.green.length));
273
274         switch (depth) {
275         case 4:
276                 for (i = 0; i < logo->height; i++)
277                         for (j = 0; j < logo->width; src++) {
278                                 *dst++ = *src >> 4;
279                                 j++;
280                                 if (j < logo->width) {
281                                         *dst++ = *src & 0x0f;
282                                         j++;
283                                 }
284                         }
285                 break;
286         case 1:
287                 for (i = 0; i < logo->height; i++) {
288                         for (j = 0; j < logo->width; src++) {
289                                 d = *src ^ xor;
290                                 for (k = 7; k >= 0; k--) {
291                                         *dst++ = ((d >> k) & 1) ? fg : 0;
292                                         j++;
293                                 }
294                         }
295                 }
296                 break;
297         }
298 }
299
300 /*
301  * Three (3) kinds of logo maps exist.  linux_logo_clut224 (>16 colors),
302  * linux_logo_vga16 (16 colors) and linux_logo_mono (2 colors).  Depending on
303  * the visual format and color depth of the framebuffer, the DAC, the
304  * pseudo_palette, and the logo data will be adjusted accordingly.
305  *
306  * Case 1 - linux_logo_clut224:
307  * Color exceeds the number of console colors (16), thus we set the hardware DAC
308  * using fb_set_cmap() appropriately.  The "needs_cmapreset"  flag will be set.
309  *
310  * For visuals that require color info from the pseudo_palette, we also construct
311  * one for temporary use. The "needs_directpalette" or "needs_truepalette" flags
312  * will be set.
313  *
314  * Case 2 - linux_logo_vga16:
315  * The number of colors just matches the console colors, thus there is no need
316  * to set the DAC or the pseudo_palette.  However, the bitmap is packed, ie,
317  * each byte contains color information for two pixels (upper and lower nibble).
318  * To be consistent with fb_imageblit() usage, we therefore separate the two
319  * nibbles into separate bytes. The "depth" flag will be set to 4.
320  *
321  * Case 3 - linux_logo_mono:
322  * This is similar with Case 2.  Each byte contains information for 8 pixels.
323  * We isolate each bit and expand each into a byte. The "depth" flag will
324  * be set to 1.
325  */
326 static struct logo_data {
327         int depth;
328         int needs_directpalette;
329         int needs_truepalette;
330         int needs_cmapreset;
331         const struct linux_logo *logo;
332 } fb_logo;
333
334 int fb_prepare_logo(struct fb_info *info)
335 {
336         int depth = fb_get_color_depth(&info->var, &info->fix);
337
338         memset(&fb_logo, 0, sizeof(struct logo_data));
339
340         if (info->flags & FBINFO_MISC_TILEBLITTING)
341                 return 0;
342
343         if (info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
344                 depth = info->var.blue.length;
345                 if (info->var.red.length < depth)
346                         depth = info->var.red.length;
347                 if (info->var.green.length < depth)
348                         depth = info->var.green.length;
349         }
350
351         if (depth >= 8) {
352                 switch (info->fix.visual) {
353                 case FB_VISUAL_TRUECOLOR:
354                         fb_logo.needs_truepalette = 1;
355                         break;
356                 case FB_VISUAL_DIRECTCOLOR:
357                         fb_logo.needs_directpalette = 1;
358                         fb_logo.needs_cmapreset = 1;
359                         break;
360                 case FB_VISUAL_PSEUDOCOLOR:
361                         fb_logo.needs_cmapreset = 1;
362                         break;
363                 }
364         }
365
366         /* Return if no suitable logo was found */
367         fb_logo.logo = fb_find_logo(depth);
368         
369         if (!fb_logo.logo || fb_logo.logo->height > info->var.yres) {
370                 fb_logo.logo = NULL;
371                 return 0;
372         }
373         /* What depth we asked for might be different from what we get */
374         if (fb_logo.logo->type == LINUX_LOGO_CLUT224)
375                 fb_logo.depth = 8;
376         else if (fb_logo.logo->type == LINUX_LOGO_VGA16)
377                 fb_logo.depth = 4;
378         else
379                 fb_logo.depth = 1;              
380         return fb_logo.logo->height;
381 }
382
383 int fb_show_logo(struct fb_info *info)
384 {
385         u32 *palette = NULL, *saved_pseudo_palette = NULL;
386         unsigned char *logo_new = NULL;
387         struct fb_image image;
388         int x;
389
390         /* Return if the frame buffer is not mapped or suspended */
391         if (fb_logo.logo == NULL || info->state != FBINFO_STATE_RUNNING)
392                 return 0;
393
394         image.depth = 8;
395         image.data = fb_logo.logo->data;
396
397         if (fb_logo.needs_cmapreset)
398                 fb_set_logocmap(info, fb_logo.logo);
399
400         if (fb_logo.needs_truepalette || 
401             fb_logo.needs_directpalette) {
402                 palette = kmalloc(256 * 4, GFP_KERNEL);
403                 if (palette == NULL)
404                         return 0;
405
406                 if (fb_logo.needs_truepalette)
407                         fb_set_logo_truepalette(info, fb_logo.logo, palette);
408                 else
409                         fb_set_logo_directpalette(info, fb_logo.logo, palette);
410
411                 saved_pseudo_palette = info->pseudo_palette;
412                 info->pseudo_palette = palette;
413         }
414
415         if (fb_logo.depth <= 4) {
416                 logo_new = kmalloc(fb_logo.logo->width * fb_logo.logo->height, 
417                                    GFP_KERNEL);
418                 if (logo_new == NULL) {
419                         kfree(palette);
420                         if (saved_pseudo_palette)
421                                 info->pseudo_palette = saved_pseudo_palette;
422                         return 0;
423                 }
424                 image.data = logo_new;
425                 fb_set_logo(info, fb_logo.logo, logo_new, fb_logo.depth);
426         }
427
428         image.width = fb_logo.logo->width;
429         image.height = fb_logo.logo->height;
430         image.dy = 0;
431
432         for (x = 0; x < num_online_cpus() * (fb_logo.logo->width + 8) &&
433              x <= info->var.xres-fb_logo.logo->width; x += (fb_logo.logo->width + 8)) {
434                 image.dx = x;
435                 info->fbops->fb_imageblit(info, &image);
436         }
437         
438         kfree(palette);
439         if (saved_pseudo_palette != NULL)
440                 info->pseudo_palette = saved_pseudo_palette;
441         kfree(logo_new);
442         return fb_logo.logo->height;
443 }
444 #else
445 int fb_prepare_logo(struct fb_info *info) { return 0; }
446 int fb_show_logo(struct fb_info *info) { return 0; }
447 #endif /* CONFIG_LOGO */
448
449 static int fbmem_read_proc(char *buf, char **start, off_t offset,
450                            int len, int *eof, void *private)
451 {
452         struct fb_info **fi;
453         int clen;
454
455         clen = 0;
456         for (fi = registered_fb; fi < &registered_fb[FB_MAX] && len < 4000; fi++)
457                 if (*fi)
458                         clen += sprintf(buf + clen, "%d %s\n",
459                                         (*fi)->node,
460                                         (*fi)->fix.id);
461         *start = buf + offset;
462         if (clen > offset)
463                 clen -= offset;
464         else
465                 clen = 0;
466         return clen < len ? clen : len;
467 }
468
469 static ssize_t
470 fb_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
471 {
472         unsigned long p = *ppos;
473         struct inode *inode = file->f_dentry->d_inode;
474         int fbidx = iminor(inode);
475         struct fb_info *info = registered_fb[fbidx];
476         u32 *buffer, *dst;
477         u32 __iomem *src;
478         int c, i, cnt = 0, err = 0;
479         unsigned long total_size;
480
481         if (!info || ! info->screen_base)
482                 return -ENODEV;
483
484         if (info->state != FBINFO_STATE_RUNNING)
485                 return -EPERM;
486
487         if (info->fbops->fb_read)
488                 return info->fbops->fb_read(file, buf, count, ppos);
489         
490         total_size = info->screen_size;
491         if (total_size == 0)
492                 total_size = info->fix.smem_len;
493
494         if (p >= total_size)
495             return 0;
496         if (count >= total_size)
497             count = total_size;
498         if (count + p > total_size)
499                 count = total_size - p;
500
501         cnt = 0;
502         buffer = kmalloc((count > PAGE_SIZE) ? PAGE_SIZE : count,
503                          GFP_KERNEL);
504         if (!buffer)
505                 return -ENOMEM;
506
507         src = (u32 __iomem *) (info->screen_base + p);
508
509         if (info->fbops->fb_sync)
510                 info->fbops->fb_sync(info);
511
512         while (count) {
513                 c  = (count > PAGE_SIZE) ? PAGE_SIZE : count;
514                 dst = buffer;
515                 for (i = c >> 2; i--; )
516                         *dst++ = fb_readl(src++);
517                 if (c & 3) {
518                         u8 *dst8 = (u8 *) dst;
519                         u8 __iomem *src8 = (u8 __iomem *) src;
520
521                         for (i = c & 3; i--;)
522                                 *dst8++ = fb_readb(src8++);
523
524                         src = (u32 __iomem *) src8;
525                 }
526
527                 if (copy_to_user(buf, buffer, c)) {
528                         err = -EFAULT;
529                         break;
530                 }
531                 *ppos += c;
532                 buf += c;
533                 cnt += c;
534                 count -= c;
535         }
536
537         kfree(buffer);
538         return (err) ? err : cnt;
539 }
540
541 static ssize_t
542 fb_write(struct file *file, const char __user *buf, size_t count, loff_t *ppos)
543 {
544         unsigned long p = *ppos;
545         struct inode *inode = file->f_dentry->d_inode;
546         int fbidx = iminor(inode);
547         struct fb_info *info = registered_fb[fbidx];
548         u32 *buffer, *src;
549         u32 __iomem *dst;
550         int c, i, cnt = 0, err;
551         unsigned long total_size;
552
553         if (!info || !info->screen_base)
554                 return -ENODEV;
555
556         if (info->state != FBINFO_STATE_RUNNING)
557                 return -EPERM;
558
559         if (info->fbops->fb_write)
560                 return info->fbops->fb_write(file, buf, count, ppos);
561         
562         total_size = info->screen_size;
563         if (total_size == 0)
564                 total_size = info->fix.smem_len;
565
566         if (p > total_size)
567             return -ENOSPC;
568         if (count >= total_size)
569             count = total_size;
570         err = 0;
571         if (count + p > total_size) {
572             count = total_size - p;
573             err = -ENOSPC;
574         }
575         cnt = 0;
576         buffer = kmalloc((count > PAGE_SIZE) ? PAGE_SIZE : count,
577                          GFP_KERNEL);
578         if (!buffer)
579                 return -ENOMEM;
580
581         dst = (u32 __iomem *) (info->screen_base + p);
582
583         if (info->fbops->fb_sync)
584                 info->fbops->fb_sync(info);
585
586         while (count) {
587                 c = (count > PAGE_SIZE) ? PAGE_SIZE : count;
588                 src = buffer;
589                 if (copy_from_user(src, buf, c)) {
590                         err = -EFAULT;
591                         break;
592                 }
593                 for (i = c >> 2; i--; )
594                         fb_writel(*src++, dst++);
595                 if (c & 3) {
596                         u8 *src8 = (u8 *) src;
597                         u8 __iomem *dst8 = (u8 __iomem *) dst;
598
599                         for (i = c & 3; i--; )
600                                 fb_writeb(*src8++, dst8++);
601
602                         dst = (u32 __iomem *) dst8;
603                 }
604                 *ppos += c;
605                 buf += c;
606                 cnt += c;
607                 count -= c;
608         }
609         kfree(buffer);
610
611         return (err) ? err : cnt;
612 }
613
614 #ifdef CONFIG_KMOD
615 static void try_to_load(int fb)
616 {
617         request_module("fb%d", fb);
618 }
619 #endif /* CONFIG_KMOD */
620
621 int
622 fb_pan_display(struct fb_info *info, struct fb_var_screeninfo *var)
623 {
624         int xoffset = var->xoffset;
625         int yoffset = var->yoffset;
626         int err;
627
628         if (xoffset < 0 || yoffset < 0 || !info->fbops->fb_pan_display ||
629             xoffset + info->var.xres > info->var.xres_virtual ||
630             yoffset + info->var.yres > info->var.yres_virtual)
631                 return -EINVAL;
632         if ((err = info->fbops->fb_pan_display(var, info)))
633                 return err;
634         info->var.xoffset = var->xoffset;
635         info->var.yoffset = var->yoffset;
636         if (var->vmode & FB_VMODE_YWRAP)
637                 info->var.vmode |= FB_VMODE_YWRAP;
638         else
639                 info->var.vmode &= ~FB_VMODE_YWRAP;
640         return 0;
641 }
642
643 int
644 fb_set_var(struct fb_info *info, struct fb_var_screeninfo *var)
645 {
646         int err, flags = info->flags;
647
648         if (var->activate & FB_ACTIVATE_INV_MODE) {
649                 struct fb_videomode mode1, mode2;
650                 int ret = 0;
651
652                 fb_var_to_videomode(&mode1, var);
653                 fb_var_to_videomode(&mode2, &info->var);
654                 /* make sure we don't delete the videomode of current var */
655                 ret = fb_mode_is_equal(&mode1, &mode2);
656
657                 if (!ret) {
658                     struct fb_event event;
659
660                     event.info = info;
661                     event.data = &mode1;
662                     ret = notifier_call_chain(&fb_notifier_list,
663                                               FB_EVENT_MODE_DELETE, &event);
664                 }
665
666                 if (!ret)
667                     fb_delete_videomode(&mode1, &info->modelist);
668
669                 return ret;
670         }
671
672         if ((var->activate & FB_ACTIVATE_FORCE) ||
673             memcmp(&info->var, var, sizeof(struct fb_var_screeninfo))) {
674                 if (!info->fbops->fb_check_var) {
675                         *var = info->var;
676                         return 0;
677                 }
678
679                 if ((err = info->fbops->fb_check_var(var, info)))
680                         return err;
681
682                 if ((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
683                         struct fb_videomode mode;
684                         int err = 0;
685
686                         info->var = *var;
687                         if (info->fbops->fb_set_par)
688                                 info->fbops->fb_set_par(info);
689
690                         fb_pan_display(info, &info->var);
691
692                         fb_set_cmap(&info->cmap, info);
693
694                         fb_var_to_videomode(&mode, &info->var);
695
696                         if (info->modelist.prev && info->modelist.next &&
697                             !list_empty(&info->modelist))
698                                 err = fb_add_videomode(&mode, &info->modelist);
699
700                         if (!err && (flags & FBINFO_MISC_USEREVENT)) {
701                                 struct fb_event event;
702                                 int evnt = (var->activate & FB_ACTIVATE_ALL) ?
703                                         FB_EVENT_MODE_CHANGE_ALL :
704                                         FB_EVENT_MODE_CHANGE;
705
706                                 info->flags &= ~FBINFO_MISC_USEREVENT;
707                                 event.info = info;
708                                 notifier_call_chain(&fb_notifier_list, evnt,
709                                                     &event);
710                         }
711                 }
712         }
713         return 0;
714 }
715
716 int
717 fb_blank(struct fb_info *info, int blank)
718 {       
719         int ret = -EINVAL;
720
721         if (blank > FB_BLANK_POWERDOWN)
722                 blank = FB_BLANK_POWERDOWN;
723
724         if (info->fbops->fb_blank)
725                 ret = info->fbops->fb_blank(blank, info);
726
727         if (!ret) {
728                 struct fb_event event;
729
730                 event.info = info;
731                 event.data = &blank;
732                 notifier_call_chain(&fb_notifier_list, FB_EVENT_BLANK, &event);
733         }
734
735         return ret;
736 }
737
738 static int 
739 fb_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
740          unsigned long arg)
741 {
742         int fbidx = iminor(inode);
743         struct fb_info *info = registered_fb[fbidx];
744         struct fb_ops *fb = info->fbops;
745         struct fb_var_screeninfo var;
746         struct fb_fix_screeninfo fix;
747         struct fb_con2fbmap con2fb;
748         struct fb_cmap_user cmap;
749         struct fb_event event;
750         void __user *argp = (void __user *)arg;
751         int i;
752         
753         if (!fb)
754                 return -ENODEV;
755         switch (cmd) {
756         case FBIOGET_VSCREENINFO:
757                 return copy_to_user(argp, &info->var,
758                                     sizeof(var)) ? -EFAULT : 0;
759         case FBIOPUT_VSCREENINFO:
760                 if (copy_from_user(&var, argp, sizeof(var)))
761                         return -EFAULT;
762                 acquire_console_sem();
763                 info->flags |= FBINFO_MISC_USEREVENT;
764                 i = fb_set_var(info, &var);
765                 info->flags &= ~FBINFO_MISC_USEREVENT;
766                 release_console_sem();
767                 if (i) return i;
768                 if (copy_to_user(argp, &var, sizeof(var)))
769                         return -EFAULT;
770                 return 0;
771         case FBIOGET_FSCREENINFO:
772                 return copy_to_user(argp, &info->fix,
773                                     sizeof(fix)) ? -EFAULT : 0;
774         case FBIOPUTCMAP:
775                 if (copy_from_user(&cmap, argp, sizeof(cmap)))
776                         return -EFAULT;
777                 return (fb_set_user_cmap(&cmap, info));
778         case FBIOGETCMAP:
779                 if (copy_from_user(&cmap, argp, sizeof(cmap)))
780                         return -EFAULT;
781                 return fb_cmap_to_user(&info->cmap, &cmap);
782         case FBIOPAN_DISPLAY:
783                 if (copy_from_user(&var, argp, sizeof(var)))
784                         return -EFAULT;
785                 acquire_console_sem();
786                 i = fb_pan_display(info, &var);
787                 release_console_sem();
788                 if (i)
789                         return i;
790                 if (copy_to_user(argp, &var, sizeof(var)))
791                         return -EFAULT;
792                 return 0;
793         case FBIO_CURSOR:
794                 return -EINVAL;
795         case FBIOGET_CON2FBMAP:
796                 if (copy_from_user(&con2fb, argp, sizeof(con2fb)))
797                         return -EFAULT;
798                 if (con2fb.console < 1 || con2fb.console > MAX_NR_CONSOLES)
799                     return -EINVAL;
800                 con2fb.framebuffer = -1;
801                 event.info = info;
802                 event.data = &con2fb;
803                 notifier_call_chain(&fb_notifier_list,
804                                     FB_EVENT_GET_CONSOLE_MAP, &event);
805                 return copy_to_user(argp, &con2fb,
806                                     sizeof(con2fb)) ? -EFAULT : 0;
807         case FBIOPUT_CON2FBMAP:
808                 if (copy_from_user(&con2fb, argp, sizeof(con2fb)))
809                         return - EFAULT;
810                 if (con2fb.console < 0 || con2fb.console > MAX_NR_CONSOLES)
811                     return -EINVAL;
812                 if (con2fb.framebuffer < 0 || con2fb.framebuffer >= FB_MAX)
813                     return -EINVAL;
814 #ifdef CONFIG_KMOD
815                 if (!registered_fb[con2fb.framebuffer])
816                     try_to_load(con2fb.framebuffer);
817 #endif /* CONFIG_KMOD */
818                 if (!registered_fb[con2fb.framebuffer])
819                     return -EINVAL;
820                 event.info = info;
821                 event.data = &con2fb;
822                 return notifier_call_chain(&fb_notifier_list,
823                                            FB_EVENT_SET_CONSOLE_MAP,
824                                            &event);
825         case FBIOBLANK:
826                 acquire_console_sem();
827                 info->flags |= FBINFO_MISC_USEREVENT;
828                 i = fb_blank(info, arg);
829                 info->flags &= ~FBINFO_MISC_USEREVENT;
830                 release_console_sem();
831                 return i;
832         default:
833                 if (fb->fb_ioctl == NULL)
834                         return -EINVAL;
835                 return fb->fb_ioctl(inode, file, cmd, arg, info);
836         }
837 }
838
839 #ifdef CONFIG_COMPAT
840 static long
841 fb_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
842 {
843         int fbidx = iminor(file->f_dentry->d_inode);
844         struct fb_info *info = registered_fb[fbidx];
845         struct fb_ops *fb = info->fbops;
846         long ret;
847
848         if (fb->fb_compat_ioctl == NULL)
849                 return -ENOIOCTLCMD;
850         lock_kernel();
851         ret = fb->fb_compat_ioctl(file, cmd, arg, info);
852         unlock_kernel();
853         return ret;
854 }
855 #endif
856
857 static int 
858 fb_mmap(struct file *file, struct vm_area_struct * vma)
859 {
860         int fbidx = iminor(file->f_dentry->d_inode);
861         struct fb_info *info = registered_fb[fbidx];
862         struct fb_ops *fb = info->fbops;
863         unsigned long off;
864 #if !defined(__sparc__) || defined(__sparc_v9__)
865         unsigned long start;
866         u32 len;
867 #endif
868
869         if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT))
870                 return -EINVAL;
871         off = vma->vm_pgoff << PAGE_SHIFT;
872         if (!fb)
873                 return -ENODEV;
874         if (fb->fb_mmap) {
875                 int res;
876                 lock_kernel();
877                 res = fb->fb_mmap(info, file, vma);
878                 unlock_kernel();
879                 return res;
880         }
881
882 #if defined(__sparc__) && !defined(__sparc_v9__)
883         /* Should never get here, all fb drivers should have their own
884            mmap routines */
885         return -EINVAL;
886 #else
887         /* !sparc32... */
888         lock_kernel();
889
890         /* frame buffer memory */
891         start = info->fix.smem_start;
892         len = PAGE_ALIGN((start & ~PAGE_MASK) + info->fix.smem_len);
893         if (off >= len) {
894                 /* memory mapped io */
895                 off -= len;
896                 if (info->var.accel_flags) {
897                         unlock_kernel();
898                         return -EINVAL;
899                 }
900                 start = info->fix.mmio_start;
901                 len = PAGE_ALIGN((start & ~PAGE_MASK) + info->fix.mmio_len);
902         }
903         unlock_kernel();
904         start &= PAGE_MASK;
905         if ((vma->vm_end - vma->vm_start + off) > len)
906                 return -EINVAL;
907         off += start;
908         vma->vm_pgoff = off >> PAGE_SHIFT;
909         /* This is an IO map - tell maydump to skip this VMA */
910         vma->vm_flags |= VM_IO | VM_RESERVED;
911 #if defined(__sparc_v9__)
912         if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT,
913                                 vma->vm_end - vma->vm_start, vma->vm_page_prot))
914                 return -EAGAIN;
915 #else
916 #if defined(__mc68000__)
917 #if defined(CONFIG_SUN3)
918         pgprot_val(vma->vm_page_prot) |= SUN3_PAGE_NOCACHE;
919 #elif defined(CONFIG_MMU)
920         if (CPU_IS_020_OR_030)
921                 pgprot_val(vma->vm_page_prot) |= _PAGE_NOCACHE030;
922         if (CPU_IS_040_OR_060) {
923                 pgprot_val(vma->vm_page_prot) &= _CACHEMASK040;
924                 /* Use no-cache mode, serialized */
925                 pgprot_val(vma->vm_page_prot) |= _PAGE_NOCACHE_S;
926         }
927 #endif
928 #elif defined(__powerpc__)
929         vma->vm_page_prot = phys_mem_access_prot(file, off,
930                                                  vma->vm_end - vma->vm_start,
931                                                  vma->vm_page_prot);
932 #elif defined(__alpha__)
933         /* Caching is off in the I/O space quadrant by design.  */
934 #elif defined(__i386__) || defined(__x86_64__)
935         if (boot_cpu_data.x86 > 3)
936                 pgprot_val(vma->vm_page_prot) |= _PAGE_PCD;
937 #elif defined(__mips__)
938         vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
939 #elif defined(__hppa__)
940         pgprot_val(vma->vm_page_prot) |= _PAGE_NO_CACHE;
941 #elif defined(__arm__) || defined(__sh__) || defined(__m32r__)
942         vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
943 #elif defined(__ia64__)
944         if (efi_range_is_wc(vma->vm_start, vma->vm_end - vma->vm_start))
945                 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
946         else
947                 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
948 #else
949 #warning What do we have to do here??
950 #endif
951         if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT,
952                              vma->vm_end - vma->vm_start, vma->vm_page_prot))
953                 return -EAGAIN;
954 #endif /* !__sparc_v9__ */
955         return 0;
956 #endif /* !sparc32 */
957 }
958
959 static int
960 fb_open(struct inode *inode, struct file *file)
961 {
962         int fbidx = iminor(inode);
963         struct fb_info *info;
964         int res = 0;
965
966         if (fbidx >= FB_MAX)
967                 return -ENODEV;
968 #ifdef CONFIG_KMOD
969         if (!(info = registered_fb[fbidx]))
970                 try_to_load(fbidx);
971 #endif /* CONFIG_KMOD */
972         if (!(info = registered_fb[fbidx]))
973                 return -ENODEV;
974         if (!try_module_get(info->fbops->owner))
975                 return -ENODEV;
976         if (info->fbops->fb_open) {
977                 res = info->fbops->fb_open(info,1);
978                 if (res)
979                         module_put(info->fbops->owner);
980         }
981         return res;
982 }
983
984 static int 
985 fb_release(struct inode *inode, struct file *file)
986 {
987         int fbidx = iminor(inode);
988         struct fb_info *info;
989
990         lock_kernel();
991         info = registered_fb[fbidx];
992         if (info->fbops->fb_release)
993                 info->fbops->fb_release(info,1);
994         module_put(info->fbops->owner);
995         unlock_kernel();
996         return 0;
997 }
998
999 static struct file_operations fb_fops = {
1000         .owner =        THIS_MODULE,
1001         .read =         fb_read,
1002         .write =        fb_write,
1003         .ioctl =        fb_ioctl,
1004 #ifdef CONFIG_COMPAT
1005         .compat_ioctl = fb_compat_ioctl,
1006 #endif
1007         .mmap =         fb_mmap,
1008         .open =         fb_open,
1009         .release =      fb_release,
1010 #ifdef HAVE_ARCH_FB_UNMAPPED_AREA
1011         .get_unmapped_area = get_fb_unmapped_area,
1012 #endif
1013 };
1014
1015 static struct class *fb_class;
1016
1017 /**
1018  *      register_framebuffer - registers a frame buffer device
1019  *      @fb_info: frame buffer info structure
1020  *
1021  *      Registers a frame buffer device @fb_info.
1022  *
1023  *      Returns negative errno on error, or zero for success.
1024  *
1025  */
1026
1027 int
1028 register_framebuffer(struct fb_info *fb_info)
1029 {
1030         int i;
1031         struct fb_event event;
1032
1033         if (num_registered_fb == FB_MAX)
1034                 return -ENXIO;
1035         num_registered_fb++;
1036         for (i = 0 ; i < FB_MAX; i++)
1037                 if (!registered_fb[i])
1038                         break;
1039         fb_info->node = i;
1040
1041         fb_info->class_device = class_device_create(fb_class, MKDEV(FB_MAJOR, i),
1042                                     fb_info->device, "fb%d", i);
1043         if (IS_ERR(fb_info->class_device)) {
1044                 /* Not fatal */
1045                 printk(KERN_WARNING "Unable to create class_device for framebuffer %d; errno = %ld\n", i, PTR_ERR(fb_info->class_device));
1046                 fb_info->class_device = NULL;
1047         } else
1048                 fb_init_class_device(fb_info);
1049
1050         if (fb_info->pixmap.addr == NULL) {
1051                 fb_info->pixmap.addr = kmalloc(FBPIXMAPSIZE, GFP_KERNEL);
1052                 if (fb_info->pixmap.addr) {
1053                         fb_info->pixmap.size = FBPIXMAPSIZE;
1054                         fb_info->pixmap.buf_align = 1;
1055                         fb_info->pixmap.scan_align = 1;
1056                         fb_info->pixmap.access_align = 32;
1057                         fb_info->pixmap.flags = FB_PIXMAP_DEFAULT;
1058                 }
1059         }       
1060         fb_info->pixmap.offset = 0;
1061
1062         if (!fb_info->modelist.prev ||
1063             !fb_info->modelist.next ||
1064             list_empty(&fb_info->modelist)) {
1065                 struct fb_videomode mode;
1066
1067                 INIT_LIST_HEAD(&fb_info->modelist);
1068                 fb_var_to_videomode(&mode, &fb_info->var);
1069                 fb_add_videomode(&mode, &fb_info->modelist);
1070         }
1071
1072         registered_fb[i] = fb_info;
1073
1074         devfs_mk_cdev(MKDEV(FB_MAJOR, i),
1075                         S_IFCHR | S_IRUGO | S_IWUGO, "fb/%d", i);
1076         event.info = fb_info;
1077         notifier_call_chain(&fb_notifier_list,
1078                             FB_EVENT_FB_REGISTERED, &event);
1079         return 0;
1080 }
1081
1082
1083 /**
1084  *      unregister_framebuffer - releases a frame buffer device
1085  *      @fb_info: frame buffer info structure
1086  *
1087  *      Unregisters a frame buffer device @fb_info.
1088  *
1089  *      Returns negative errno on error, or zero for success.
1090  *
1091  */
1092
1093 int
1094 unregister_framebuffer(struct fb_info *fb_info)
1095 {
1096         int i;
1097
1098         i = fb_info->node;
1099         if (!registered_fb[i])
1100                 return -EINVAL;
1101         devfs_remove("fb/%d", i);
1102
1103         if (fb_info->pixmap.addr && (fb_info->pixmap.flags & FB_PIXMAP_DEFAULT))
1104                 kfree(fb_info->pixmap.addr);
1105         fb_destroy_modelist(&fb_info->modelist);
1106         registered_fb[i]=NULL;
1107         num_registered_fb--;
1108         fb_cleanup_class_device(fb_info);
1109         class_device_destroy(fb_class, MKDEV(FB_MAJOR, i));
1110         return 0;
1111 }
1112
1113 /**
1114  *      fb_register_client - register a client notifier
1115  *      @nb: notifier block to callback on events
1116  */
1117 int fb_register_client(struct notifier_block *nb)
1118 {
1119         return notifier_chain_register(&fb_notifier_list, nb);
1120 }
1121
1122 /**
1123  *      fb_unregister_client - unregister a client notifier
1124  *      @nb: notifier block to callback on events
1125  */
1126 int fb_unregister_client(struct notifier_block *nb)
1127 {
1128         return notifier_chain_unregister(&fb_notifier_list, nb);
1129 }
1130
1131 /**
1132  *      fb_set_suspend - low level driver signals suspend
1133  *      @info: framebuffer affected
1134  *      @state: 0 = resuming, !=0 = suspending
1135  *
1136  *      This is meant to be used by low level drivers to
1137  *      signal suspend/resume to the core & clients.
1138  *      It must be called with the console semaphore held
1139  */
1140 void fb_set_suspend(struct fb_info *info, int state)
1141 {
1142         struct fb_event event;
1143
1144         event.info = info;
1145         if (state) {
1146                 notifier_call_chain(&fb_notifier_list, FB_EVENT_SUSPEND, &event);
1147                 info->state = FBINFO_STATE_SUSPENDED;
1148         } else {
1149                 info->state = FBINFO_STATE_RUNNING;
1150                 notifier_call_chain(&fb_notifier_list, FB_EVENT_RESUME, &event);
1151         }
1152 }
1153
1154 /**
1155  *      fbmem_init - init frame buffer subsystem
1156  *
1157  *      Initialize the frame buffer subsystem.
1158  *
1159  *      NOTE: This function is _only_ to be called by drivers/char/mem.c.
1160  *
1161  */
1162
1163 static int __init
1164 fbmem_init(void)
1165 {
1166         create_proc_read_entry("fb", 0, NULL, fbmem_read_proc, NULL);
1167
1168         devfs_mk_dir("fb");
1169         if (register_chrdev(FB_MAJOR,"fb",&fb_fops))
1170                 printk("unable to get major %d for fb devs\n", FB_MAJOR);
1171
1172         fb_class = class_create(THIS_MODULE, "graphics");
1173         if (IS_ERR(fb_class)) {
1174                 printk(KERN_WARNING "Unable to create fb class; errno = %ld\n", PTR_ERR(fb_class));
1175                 fb_class = NULL;
1176         }
1177         return 0;
1178 }
1179
1180 #ifdef MODULE
1181 module_init(fbmem_init);
1182 static void __exit
1183 fbmem_exit(void)
1184 {
1185         class_destroy(fb_class);
1186         unregister_chrdev(FB_MAJOR, "fb");
1187 }
1188
1189 module_exit(fbmem_exit);
1190 MODULE_LICENSE("GPL");
1191 MODULE_DESCRIPTION("Framebuffer base");
1192 #else
1193 subsys_initcall(fbmem_init);
1194 #endif
1195
1196 int fb_new_modelist(struct fb_info *info)
1197 {
1198         struct fb_event event;
1199         struct fb_var_screeninfo var = info->var;
1200         struct list_head *pos, *n;
1201         struct fb_modelist *modelist;
1202         struct fb_videomode *m, mode;
1203         int err = 1;
1204
1205         list_for_each_safe(pos, n, &info->modelist) {
1206                 modelist = list_entry(pos, struct fb_modelist, list);
1207                 m = &modelist->mode;
1208                 fb_videomode_to_var(&var, m);
1209                 var.activate = FB_ACTIVATE_TEST;
1210                 err = fb_set_var(info, &var);
1211                 fb_var_to_videomode(&mode, &var);
1212                 if (err || !fb_mode_is_equal(m, &mode)) {
1213                         list_del(pos);
1214                         kfree(pos);
1215                 }
1216         }
1217
1218         err = 1;
1219
1220         if (!list_empty(&info->modelist)) {
1221                 event.info = info;
1222                 err = notifier_call_chain(&fb_notifier_list,
1223                                            FB_EVENT_NEW_MODELIST,
1224                                            &event);
1225         }
1226
1227         return err;
1228 }
1229
1230 static char *video_options[FB_MAX];
1231 static int ofonly;
1232
1233 extern const char *global_mode_option;
1234
1235 /**
1236  * fb_get_options - get kernel boot parameters
1237  * @name:   framebuffer name as it would appear in
1238  *          the boot parameter line
1239  *          (video=<name>:<options>)
1240  * @option: the option will be stored here
1241  *
1242  * NOTE: Needed to maintain backwards compatibility
1243  */
1244 int fb_get_options(char *name, char **option)
1245 {
1246         char *opt, *options = NULL;
1247         int opt_len, retval = 0;
1248         int name_len = strlen(name), i;
1249
1250         if (name_len && ofonly && strncmp(name, "offb", 4))
1251                 retval = 1;
1252
1253         if (name_len && !retval) {
1254                 for (i = 0; i < FB_MAX; i++) {
1255                         if (video_options[i] == NULL)
1256                                 continue;
1257                         opt_len = strlen(video_options[i]);
1258                         if (!opt_len)
1259                                 continue;
1260                         opt = video_options[i];
1261                         if (!strncmp(name, opt, name_len) &&
1262                             opt[name_len] == ':')
1263                                 options = opt + name_len + 1;
1264                 }
1265         }
1266         if (options && !strncmp(options, "off", 3))
1267                 retval = 1;
1268
1269         if (option)
1270                 *option = options;
1271
1272         return retval;
1273 }
1274
1275 /**
1276  *      video_setup - process command line options
1277  *      @options: string of options
1278  *
1279  *      Process command line options for frame buffer subsystem.
1280  *
1281  *      NOTE: This function is a __setup and __init function.
1282  *            It only stores the options.  Drivers have to call
1283  *            fb_get_options() as necessary.
1284  *
1285  *      Returns zero.
1286  *
1287  */
1288 static int __init video_setup(char *options)
1289 {
1290         int i, global = 0;
1291
1292         if (!options || !*options)
1293                 global = 1;
1294
1295         if (!global && !strncmp(options, "ofonly", 6)) {
1296                 ofonly = 1;
1297                 global = 1;
1298         }
1299
1300         if (!global && !strstr(options, "fb:")) {
1301                 global_mode_option = options;
1302                 global = 1;
1303         }
1304
1305         if (!global) {
1306                 for (i = 0; i < FB_MAX; i++) {
1307                         if (video_options[i] == NULL) {
1308                                 video_options[i] = options;
1309                                 break;
1310                         }
1311
1312                 }
1313         }
1314
1315         return 0;
1316 }
1317 __setup("video=", video_setup);
1318
1319     /*
1320      *  Visible symbols for modules
1321      */
1322
1323 EXPORT_SYMBOL(register_framebuffer);
1324 EXPORT_SYMBOL(unregister_framebuffer);
1325 EXPORT_SYMBOL(num_registered_fb);
1326 EXPORT_SYMBOL(registered_fb);
1327 EXPORT_SYMBOL(fb_prepare_logo);
1328 EXPORT_SYMBOL(fb_show_logo);
1329 EXPORT_SYMBOL(fb_set_var);
1330 EXPORT_SYMBOL(fb_blank);
1331 EXPORT_SYMBOL(fb_pan_display);
1332 EXPORT_SYMBOL(fb_get_buffer_offset);
1333 EXPORT_SYMBOL(fb_set_suspend);
1334 EXPORT_SYMBOL(fb_register_client);
1335 EXPORT_SYMBOL(fb_unregister_client);
1336 EXPORT_SYMBOL(fb_get_options);
1337 EXPORT_SYMBOL(fb_new_modelist);
1338
1339 MODULE_LICENSE("GPL");