1
2
3
4
5
6
7
8
9
10
11
12
13
14
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/vmalloc.h>
24#include <linux/delay.h>
25#include <linux/interrupt.h>
26#include <linux/fb.h>
27#include <linux/init.h>
28#include <asm/io.h>
29#include <asm/jazz.h>
30
31
32
33
34#define G364_MEM_BASE 0xe4400000
35#define G364_PORT_BASE 0xe4000000
36#define ID_REG 0xe4000000
37#define BOOT_REG 0xe4080000
38#define TIMING_REG 0xe4080108
39#define DISPLAY_REG 0xe4080118
40#define VDISPLAY_REG 0xe4080150
41#define MASK_REG 0xe4080200
42#define CTLA_REG 0xe4080300
43#define CURS_TOGGLE 0x800000
44#define BIT_PER_PIX 0x700000
45#define DELAY_SAMPLE 0x080000
46#define PORT_INTER 0x040000
47#define PIX_PIPE_DEL 0x030000
48#define PIX_PIPE_DEL2 0x008000
49#define TR_CYCLE_TOG 0x004000
50#define VRAM_ADR_INC 0x003000
51#define BLANK_OFF 0x000800
52#define FORCE_BLANK 0x000400
53#define BLK_FUN_SWTCH 0x000200
54#define BLANK_IO 0x000100
55#define BLANK_LEVEL 0x000080
56#define A_VID_FORM 0x000040
57#define D_SYNC_FORM 0x000020
58#define FRAME_FLY_PAT 0x000010
59#define OP_MODE 0x000008
60#define INTL_STAND 0x000004
61#define SCRN_FORM 0x000002
62#define ENABLE_VTG 0x000001
63#define TOP_REG 0xe4080400
64#define CURS_PAL_REG 0xe4080508
65#define CHKSUM_REG 0xe4080600
66#define CURS_POS_REG 0xe4080638
67#define CLR_PAL_REG 0xe4080800
68#define CURS_PAT_REG 0xe4081000
69#define MON_ID_REG 0xe4100000
70#define RESET_REG 0xe4180000
71
72static struct fb_info fb_info;
73
74static struct fb_fix_screeninfo fb_fix __initdata = {
75 .id = "G364 8plane",
76 .smem_start = 0x40000000,
77 .type = FB_TYPE_PACKED_PIXELS,
78 .visual = FB_VISUAL_PSEUDOCOLOR,
79 .ypanstep = 1,
80 .accel = FB_ACCEL_NONE,
81};
82
83static struct fb_var_screeninfo fb_var __initdata = {
84 .bits_per_pixel = 8,
85 .red = { 0, 8, 0 },
86 .green = { 0, 8, 0 },
87 .blue = { 0, 8, 0 },
88 .activate = FB_ACTIVATE_NOW,
89 .height = -1,
90 .width = -1,
91 .pixclock = 39722,
92 .left_margin = 40,
93 .right_margin = 24,
94 .upper_margin = 32,
95 .lower_margin = 11,
96 .hsync_len = 96,
97 .vsync_len = 2,
98 .vmode = FB_VMODE_NONINTERLACED,
99};
100
101
102
103
104int g364fb_init(void);
105
106static int g364fb_pan_display(struct fb_var_screeninfo *var,
107 struct fb_info *info);
108static int g364fb_setcolreg(u_int regno, u_int red, u_int green,
109 u_int blue, u_int transp,
110 struct fb_info *info);
111static int g364fb_cursor(struct fb_info *info, struct fb_cursor *cursor);
112static int g364fb_blank(int blank, struct fb_info *info);
113
114static struct fb_ops g364fb_ops = {
115 .owner = THIS_MODULE,
116 .fb_setcolreg = g364fb_setcolreg,
117 .fb_pan_display = g364fb_pan_display,
118 .fb_blank = g364fb_blank,
119 .fb_fillrect = cfb_fillrect,
120 .fb_copyarea = cfb_copyarea,
121 .fb_imageblit = cfb_imageblit,
122 .fb_cursor = g364fb_cursor,
123};
124
125int g364fb_cursor(struct fb_info *info, struct fb_cursor *cursor)
126{
127
128 switch (cursor->enable) {
129 case CM_ERASE:
130 *(unsigned int *) CTLA_REG |= CURS_TOGGLE;
131 break;
132
133 case CM_MOVE:
134 case CM_DRAW:
135 *(unsigned int *) CTLA_REG &= ~CURS_TOGGLE;
136 *(unsigned int *) CURS_POS_REG =
137 ((x * fontwidth(p)) << 12) | ((y * fontheight(p)) -
138 info->var.yoffset);
139 break;
140 }
141 return 0;
142}
143
144
145
146
147
148
149static int g364fb_pan_display(struct fb_var_screeninfo *var,
150 struct fb_info *info)
151{
152 if (var->xoffset ||
153 var->yoffset + info->var.yres > info->var.yres_virtual)
154 return -EINVAL;
155
156 *(unsigned int *) TOP_REG = var->yoffset * info->var.xres;
157 return 0;
158}
159
160
161
162
163static 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
174
175static 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
194
195int __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
207
208
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
217 curs_pal_ptr[0] |= 0x00ffffff;
218 curs_pal_ptr[2] |= 0x00ffffff;
219 curs_pal_ptr[4] |= 0x00ffffff;
220
221
222
223
224 for (i = 0; i < 512; i++)
225 *(unsigned short *) (CURS_PAT_REG + i * 8) = 0;
226
227
228
229
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;
236
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;
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
254module_init(g364fb_init);
255MODULE_LICENSE("GPL");
256