x86: set_highmem_pages_init() cleanup, #2
[linux-2.6] / drivers / video / g364fb.c
1 /* $Id: g364fb.c,v 1.3 1998/08/28 22:43:00 tsbogend Exp $
2  *
3  * linux/drivers/video/g364fb.c -- Mips Magnum frame buffer device
4  *
5  * (C) 1998 Thomas Bogendoerfer
6  *
7  *  This driver is based on tgafb.c
8  *
9  *      Copyright (C) 1997 Geert Uytterhoeven 
10  *      Copyright (C) 1995  Jay Estabrook
11  *
12  *  This file is subject to the terms and conditions of the GNU General Public
13  *  License. See the file COPYING in the main directory of this archive for
14  *  more details.
15  */
16
17 #include <linux/module.h>
18 #include <linux/console.h>
19 #include <linux/kernel.h>
20 #include <linux/errno.h>
21 #include <linux/string.h>
22 #include <linux/mm.h>
23 #include <linux/slab.h>
24 #include <linux/vmalloc.h>
25 #include <linux/delay.h>
26 #include <linux/interrupt.h>
27 #include <linux/fb.h>
28 #include <linux/init.h>
29 #include <asm/io.h>
30 #include <asm/jazz.h>
31
32 /* 
33  * Various defines for the G364
34  */
35 #define G364_MEM_BASE   0xe4400000
36 #define G364_PORT_BASE  0xe4000000
37 #define ID_REG          0xe4000000      /* Read only */
38 #define BOOT_REG        0xe4080000
39 #define TIMING_REG      0xe4080108      /* to 0x080170 - DON'T TOUCH! */
40 #define DISPLAY_REG     0xe4080118
41 #define VDISPLAY_REG    0xe4080150
42 #define MASK_REG        0xe4080200
43 #define CTLA_REG        0xe4080300
44 #define CURS_TOGGLE     0x800000
45 #define BIT_PER_PIX     0x700000        /* bits 22 to 20 of Control A */
46 #define DELAY_SAMPLE    0x080000
47 #define PORT_INTER      0x040000
48 #define PIX_PIPE_DEL    0x030000        /* bits 17 and 16 of Control A */
49 #define PIX_PIPE_DEL2   0x008000        /* same as above - don't ask me why */
50 #define TR_CYCLE_TOG    0x004000
51 #define VRAM_ADR_INC    0x003000        /* bits 13 and 12 of Control A */
52 #define BLANK_OFF       0x000800
53 #define FORCE_BLANK     0x000400
54 #define BLK_FUN_SWTCH   0x000200
55 #define BLANK_IO        0x000100
56 #define BLANK_LEVEL     0x000080
57 #define A_VID_FORM      0x000040
58 #define D_SYNC_FORM     0x000020
59 #define FRAME_FLY_PAT   0x000010
60 #define OP_MODE         0x000008
61 #define INTL_STAND      0x000004
62 #define SCRN_FORM       0x000002
63 #define ENABLE_VTG      0x000001
64 #define TOP_REG         0xe4080400
65 #define CURS_PAL_REG    0xe4080508      /* to 0x080518 */
66 #define CHKSUM_REG      0xe4080600      /* to 0x080610 - unused */
67 #define CURS_POS_REG    0xe4080638
68 #define CLR_PAL_REG     0xe4080800      /* to 0x080ff8 */
69 #define CURS_PAT_REG    0xe4081000      /* to 0x081ff8 */
70 #define MON_ID_REG      0xe4100000      /* unused */
71 #define RESET_REG       0xe4180000      /* Write only */
72
73 static struct fb_info fb_info;
74
75 static struct fb_fix_screeninfo fb_fix __initdata = {
76         .id             = "G364 8plane",
77         .smem_start     = 0x40000000,   /* physical address */
78         .type           = FB_TYPE_PACKED_PIXELS,
79         .visual         = FB_VISUAL_PSEUDOCOLOR,
80         .ypanstep       = 1,
81         .accel          = FB_ACCEL_NONE,
82 };
83
84 static struct fb_var_screeninfo fb_var __initdata = {
85         .bits_per_pixel = 8,
86         .red            = { 0, 8, 0 },
87         .green          = { 0, 8, 0 },
88         .blue           = { 0, 8, 0 },
89         .activate       = FB_ACTIVATE_NOW,
90         .height         = -1,
91         .width          = -1,
92         .pixclock       = 39722,
93         .left_margin    = 40,
94         .right_margin   = 24,
95         .upper_margin   = 32,
96         .lower_margin   = 11,
97         .hsync_len      = 96,
98         .vsync_len      = 2,
99         .vmode          = FB_VMODE_NONINTERLACED,
100 };
101
102 /*
103  *  Interface used by the world
104  */
105 int g364fb_init(void);
106
107 static int g364fb_pan_display(struct fb_var_screeninfo *var,
108                               struct fb_info *info);
109 static int g364fb_setcolreg(u_int regno, u_int red, u_int green,
110                             u_int blue, u_int transp,
111                             struct fb_info *info);
112 static int g364fb_cursor(struct fb_info *info, struct fb_cursor *cursor);
113 static int g364fb_blank(int blank, struct fb_info *info);
114
115 static struct fb_ops g364fb_ops = {
116         .owner          = THIS_MODULE,
117         .fb_setcolreg   = g364fb_setcolreg,
118         .fb_pan_display = g364fb_pan_display,
119         .fb_blank       = g364fb_blank,
120         .fb_fillrect    = cfb_fillrect,
121         .fb_copyarea    = cfb_copyarea,
122         .fb_imageblit   = cfb_imageblit,
123         .fb_cursor      = g364fb_cursor,
124 };
125
126 int g364fb_cursor(struct fb_info *info, struct fb_cursor *cursor)
127 {
128         
129         switch (cursor->enable) {
130         case CM_ERASE:
131                 *(unsigned int *) CTLA_REG |= CURS_TOGGLE;
132                 break;
133
134         case CM_MOVE:
135         case CM_DRAW:
136                 *(unsigned int *) CTLA_REG &= ~CURS_TOGGLE;
137                 *(unsigned int *) CURS_POS_REG =
138                     ((x * fontwidth(p)) << 12) | ((y * fontheight(p)) -
139                                                   info->var.yoffset);
140                 break;
141         }
142         return 0;
143 }
144
145 /*
146  *  Pan or Wrap the Display
147  *
148  *  This call looks only at xoffset, yoffset and the FB_VMODE_YWRAP flag
149  */
150 static int g364fb_pan_display(struct fb_var_screeninfo *var, 
151                               struct fb_info *info)
152 {
153         if (var->xoffset || var->yoffset + var->yres > var->yres_virtual)
154                 return -EINVAL;
155
156         *(unsigned int *) TOP_REG = var->yoffset * var->xres;
157         return 0;
158 }
159
160 /*
161  *  Blank the display.
162  */
163 static int g364fb_blank(int blank, struct fb_info *info)
164 {
165         if (blank)
166                 *(unsigned int *) CTLA_REG |= FORCE_BLANK;
167         else
168                 *(unsigned int *) CTLA_REG &= ~FORCE_BLANK;
169         return 0;
170 }
171
172 /*
173  *  Set a single color register. Return != 0 for invalid regno.
174  */
175 static int g364fb_setcolreg(u_int regno, u_int red, u_int green,
176                             u_int blue, u_int transp, struct fb_info *info)
177 {
178         volatile unsigned int *ptr = (volatile unsigned int *) CLR_PAL_REG;
179
180         if (regno > 255)
181                 return 1;
182
183         red >>= 8;
184         green >>= 8;
185         blue >>= 8;
186
187         ptr[regno << 1] = (red << 16) | (green << 8) | blue;
188
189         return 0;
190 }
191
192 /*
193  *  Initialisation
194  */
195 int __init g364fb_init(void)
196 {
197         volatile unsigned int *pal_ptr =
198             (volatile unsigned int *) CLR_PAL_REG;
199         volatile unsigned int *curs_pal_ptr =
200             (volatile unsigned int *) CURS_PAL_REG;
201         int mem, i, j;
202
203         if (fb_get_options("g364fb", NULL))
204                 return -ENODEV;
205
206         /* TBD: G364 detection */
207
208         /* get the resolution set by ARC console */
209         *(volatile unsigned int *) CTLA_REG &= ~ENABLE_VTG;
210         fb_var.xres =
211             (*((volatile unsigned int *) DISPLAY_REG) & 0x00ffffff) * 4;
212         fb_var.yres =
213             (*((volatile unsigned int *) VDISPLAY_REG) & 0x00ffffff) / 2;
214         *(volatile unsigned int *) CTLA_REG |= ENABLE_VTG;
215
216         /* setup cursor */
217         curs_pal_ptr[0] |= 0x00ffffff;
218         curs_pal_ptr[2] |= 0x00ffffff;
219         curs_pal_ptr[4] |= 0x00ffffff;
220
221         /*
222          * first set the whole cursor to transparent
223          */
224         for (i = 0; i < 512; i++)
225                 *(unsigned short *) (CURS_PAT_REG + i * 8) = 0;
226
227         /*
228          * switch the last two lines to cursor palette 3
229          * we assume here, that FONTSIZE_X is 8
230          */
231         *(unsigned short *) (CURS_PAT_REG + 14 * 64) = 0xffff;
232         *(unsigned short *) (CURS_PAT_REG + 15 * 64) = 0xffff;
233         fb_var.xres_virtual = fbvar.xres;
234         fb_fix.line_length = (xres / 8) * fb_var.bits_per_pixel;
235         fb_fix.smem_start = 0x40000000; /* physical address */
236         /* get size of video memory; this is special for the JAZZ hardware */
237         mem = (r4030_read_reg32(JAZZ_R4030_CONFIG) >> 8) & 3;
238         fb_fix.smem_len = (1 << (mem * 2)) * 512 * 1024;
239         fb_var.yres_virtual = fb_fix.smem_len / fb_var.xres;
240
241         fb_info.fbops = &g364fb_ops;
242         fb_info.screen_base = (char *) G364_MEM_BASE;   /* virtual kernel address */
243         fb_info.var = fb_var;
244         fb_info.fix = fb_fix;
245         fb_info.flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
246
247         fb_alloc_cmap(&fb_info.cmap, 255, 0);
248
249         if (register_framebuffer(&fb_info) < 0)
250                 return -EINVAL;
251         return 0;
252 }
253
254 module_init(g364fb_init);
255 MODULE_LICENSE("GPL");