[PATCH] fbcon: Use helper function when filling out var structure
[linux-2.6] / drivers / video / maxinefb.c
1 /*
2  *      linux/drivers/video/maxinefb.c
3  *
4  *      DECstation 5000/xx onboard framebuffer support ... derived from:
5  *      "HP300 Topcat framebuffer support (derived from macfb of all things)
6  *      Phil Blundell <philb@gnu.org> 1998", the original code can be
7  *      found in the file hpfb.c in the same directory.
8  *
9  *      DECstation related code Copyright (C) 1999,2000,2001 by
10  *      Michael Engel <engel@unix-ag.org> and
11  *      Karsten Merker <merker@linuxtag.org>.
12  *      This file is subject to the terms and conditions of the GNU General
13  *      Public License.  See the file COPYING in the main directory of this
14  *      archive for more details.
15  *
16  */
17
18 /*
19  * Changes:
20  * 2001/01/27 removed debugging and testing code, fixed fb_ops
21  *            initialization which had caused a crash before,
22  *            general cleanup, first official release (KM)
23  *
24  */
25
26 #include <linux/module.h>
27 #include <linux/kernel.h>
28 #include <linux/sched.h>
29 #include <linux/errno.h>
30 #include <linux/string.h>
31 #include <linux/mm.h>
32 #include <linux/tty.h>
33 #include <linux/slab.h>
34 #include <linux/delay.h>
35 #include <linux/init.h>
36 #include <linux/fb.h>
37 #include <video/maxinefb.h>
38
39 /* bootinfo.h defines the machine type values, needed when checking */
40 /* whether are really running on a maxine, KM                       */
41 #include <asm/bootinfo.h>
42
43 static struct fb_info fb_info;
44
45 static struct fb_var_screeninfo maxinefb_defined = {
46         .xres =         1024,
47         .yres =         768,
48         .xres_virtual = 1024,
49         .yres_virtual = 768,
50         .bits_per_pixel =8,
51         .activate =     FB_ACTIVATE_NOW,
52         .height =       -1,
53         .width =        -1,
54         .vmode =        FB_VMODE_NONINTERLACED,
55 };
56
57 static struct fb_fix_screeninfo maxinefb_fix = {
58         .id =           "Maxine onboard graphics 1024x768x8",
59         .smem_len =     (1024*768),
60         .type =         FB_TYPE_PACKED_PIXELS,
61         .visual =       FB_VISUAL_PSEUDOCOLOR,
62         .line_length =  1024,
63 };
64
65 /* Handle the funny Inmos RamDAC/video controller ... */
66
67 void maxinefb_ims332_write_register(int regno, register unsigned int val)
68 {
69         register unsigned char *regs = (char *) MAXINEFB_IMS332_ADDRESS;
70         unsigned char *wptr;
71
72         wptr = regs + 0xa0000 + (regno << 4);
73         *((volatile unsigned int *) (regs)) = (val >> 8) & 0xff00;
74         *((volatile unsigned short *) (wptr)) = val;
75 }
76
77 unsigned int maxinefb_ims332_read_register(int regno)
78 {
79         register unsigned char *regs = (char *) MAXINEFB_IMS332_ADDRESS;
80         unsigned char *rptr;
81         register unsigned int j, k;
82
83         rptr = regs + 0x80000 + (regno << 4);
84         j = *((volatile unsigned short *) rptr);
85         k = *((volatile unsigned short *) regs);
86
87         return (j & 0xffff) | ((k & 0xff00) << 8);
88 }
89
90 /* Set the palette */
91 static int maxinefb_setcolreg(unsigned regno, unsigned red, unsigned green,
92                               unsigned blue, unsigned transp, struct fb_info *info)
93 {
94         /* value to be written into the palette reg. */
95         unsigned long hw_colorvalue = 0;
96
97         red   >>= 8;    /* The cmap fields are 16 bits    */
98         green >>= 8;    /* wide, but the harware colormap */
99         blue  >>= 8;    /* registers are only 8 bits wide */
100
101         hw_colorvalue = (blue << 16) + (green << 8) + (red);
102
103         maxinefb_ims332_write_register(IMS332_REG_COLOR_PALETTE + regno,
104                                        hw_colorvalue);
105         return 0;
106 }
107
108 static struct fb_ops maxinefb_ops = {
109         .owner          = THIS_MODULE,
110         .fb_get_fix     = gen_get_fix,
111         .fb_get_var     = gen_get_var,
112         .fb_setcolreg   = maxinefb_setcolreg,
113         .fb_fillrect    = cfb_fillrect,
114         .fb_copyarea    = cfb_copyarea,
115         .fb_imageblit   = cfb_imageblit,
116 };
117
118 int __init maxinefb_init(void)
119 {
120         unsigned long fboff;
121         unsigned long fb_start;
122         int i;
123
124         if (fb_get_options("maxinefb", NULL))
125                 return -ENODEV;
126
127         /* Validate we're on the proper machine type */
128         if (mips_machtype != MACH_DS5000_XX) {
129                 return -EINVAL;
130         }
131
132         printk(KERN_INFO "Maxinefb: Personal DECstation detected\n");
133         printk(KERN_INFO "Maxinefb: initializing onboard framebuffer\n");
134
135         /* Framebuffer display memory base address */
136         fb_start = DS5000_xx_ONBOARD_FBMEM_START;
137
138         /* Clear screen */
139         for (fboff = fb_start; fboff < fb_start + 0x1ffff; fboff++)
140                 *(volatile unsigned char *)fboff = 0x0;
141
142         maxinefb_fix.smem_start = fb_start;
143         
144         /* erase hardware cursor */
145         for (i = 0; i < 512; i++) {
146                 maxinefb_ims332_write_register(IMS332_REG_CURSOR_RAM + i,
147                                                0);
148                 /*
149                    if (i&0x8 == 0)
150                    maxinefb_ims332_write_register (IMS332_REG_CURSOR_RAM + i, 0x0f);
151                    else
152                    maxinefb_ims332_write_register (IMS332_REG_CURSOR_RAM + i, 0xf0);
153                  */
154         }
155
156         fb_info.fbops = &maxinefb_ops;
157         fb_info.screen_base = (char *)maxinefb_fix.smem_start;
158         fb_info.var = maxinefb_defined;
159         fb_info.fix = maxinefb_fix;
160         fb_info.flags = FBINFO_DEFAULT;
161
162         fb_alloc_cmap(&fb_info.cmap, 256, 0);
163
164         if (register_framebuffer(&fb_info) < 0)
165                 return 1;
166         return 0;
167 }
168
169 static void __exit maxinefb_exit(void)
170 {
171         unregister_framebuffer(&fb_info);
172 }
173
174 #ifdef MODULE
175 MODULE_LICENSE("GPL");
176 #endif
177 module_init(maxinefb_init);
178 module_exit(maxinefb_exit);
179