Root/
1 | /* |
2 | * HP300 Topcat framebuffer support (derived from macfb of all things) |
3 | * Phil Blundell <philb@gnu.org> 1998 |
4 | * DIO-II, colour map and Catseye support by |
5 | * Kars de Jong <jongk@linux-m68k.org>, May 2004. |
6 | */ |
7 | |
8 | #include <linux/module.h> |
9 | #include <linux/kernel.h> |
10 | #include <linux/errno.h> |
11 | #include <linux/string.h> |
12 | #include <linux/mm.h> |
13 | #include <linux/delay.h> |
14 | #include <linux/init.h> |
15 | #include <linux/fb.h> |
16 | #include <linux/dio.h> |
17 | |
18 | #include <asm/io.h> |
19 | #include <asm/uaccess.h> |
20 | |
21 | static struct fb_info fb_info = { |
22 | .fix = { |
23 | .id = "HP300 ", |
24 | .type = FB_TYPE_PACKED_PIXELS, |
25 | .visual = FB_VISUAL_PSEUDOCOLOR, |
26 | .accel = FB_ACCEL_NONE, |
27 | } |
28 | }; |
29 | |
30 | static unsigned long fb_regs; |
31 | static unsigned char fb_bitmask; |
32 | |
33 | #define TC_NBLANK 0x4080 |
34 | #define TC_WEN 0x4088 |
35 | #define TC_REN 0x408c |
36 | #define TC_FBEN 0x4090 |
37 | #define TC_PRR 0x40ea |
38 | |
39 | /* These defines match the X window system */ |
40 | #define RR_CLEAR 0x0 |
41 | #define RR_COPY 0x3 |
42 | #define RR_NOOP 0x5 |
43 | #define RR_XOR 0x6 |
44 | #define RR_INVERT 0xa |
45 | #define RR_COPYINVERTED 0xc |
46 | #define RR_SET 0xf |
47 | |
48 | /* blitter regs */ |
49 | #define BUSY 0x4044 |
50 | #define WMRR 0x40ef |
51 | #define SOURCE_X 0x40f2 |
52 | #define SOURCE_Y 0x40f6 |
53 | #define DEST_X 0x40fa |
54 | #define DEST_Y 0x40fe |
55 | #define WHEIGHT 0x4106 |
56 | #define WWIDTH 0x4102 |
57 | #define WMOVE 0x409c |
58 | |
59 | static struct fb_var_screeninfo hpfb_defined = { |
60 | .red = { |
61 | .length = 8, |
62 | }, |
63 | .green = { |
64 | .length = 8, |
65 | }, |
66 | .blue = { |
67 | .length = 8, |
68 | }, |
69 | .activate = FB_ACTIVATE_NOW, |
70 | .height = -1, |
71 | .width = -1, |
72 | .vmode = FB_VMODE_NONINTERLACED, |
73 | }; |
74 | |
75 | static int hpfb_setcolreg(unsigned regno, unsigned red, unsigned green, |
76 | unsigned blue, unsigned transp, |
77 | struct fb_info *info) |
78 | { |
79 | /* use MSBs */ |
80 | unsigned char _red =red>>8; |
81 | unsigned char _green=green>>8; |
82 | unsigned char _blue =blue>>8; |
83 | unsigned char _regno=regno; |
84 | |
85 | /* |
86 | * Set a single color register. The values supplied are |
87 | * already rounded down to the hardware's capabilities |
88 | * (according to the entries in the `var' structure). Return |
89 | * != 0 for invalid regno. |
90 | */ |
91 | |
92 | if (regno >= info->cmap.len) |
93 | return 1; |
94 | |
95 | while (in_be16(fb_regs + 0x6002) & 0x4) udelay(1); |
96 | |
97 | out_be16(fb_regs + 0x60ba, 0xff); |
98 | |
99 | out_be16(fb_regs + 0x60b2, _red); |
100 | out_be16(fb_regs + 0x60b4, _green); |
101 | out_be16(fb_regs + 0x60b6, _blue); |
102 | out_be16(fb_regs + 0x60b8, ~_regno); |
103 | out_be16(fb_regs + 0x60f0, 0xff); |
104 | |
105 | udelay(100); |
106 | |
107 | while (in_be16(fb_regs + 0x6002) & 0x4) udelay(1); |
108 | out_be16(fb_regs + 0x60b2, 0); |
109 | out_be16(fb_regs + 0x60b4, 0); |
110 | out_be16(fb_regs + 0x60b6, 0); |
111 | out_be16(fb_regs + 0x60b8, 0); |
112 | |
113 | return 0; |
114 | } |
115 | |
116 | /* 0 unblank, 1 blank, 2 no vsync, 3 no hsync, 4 off */ |
117 | |
118 | static int hpfb_blank(int blank, struct fb_info *info) |
119 | { |
120 | out_8(fb_regs + TC_NBLANK, (blank ? 0x00 : fb_bitmask)); |
121 | |
122 | return 0; |
123 | } |
124 | |
125 | static void topcat_blit(int x0, int y0, int x1, int y1, int w, int h, int rr) |
126 | { |
127 | if (rr >= 0) { |
128 | while (in_8(fb_regs + BUSY) & fb_bitmask) |
129 | ; |
130 | } |
131 | out_8(fb_regs + TC_FBEN, fb_bitmask); |
132 | if (rr >= 0) { |
133 | out_8(fb_regs + TC_WEN, fb_bitmask); |
134 | out_8(fb_regs + WMRR, rr); |
135 | } |
136 | out_be16(fb_regs + SOURCE_X, x0); |
137 | out_be16(fb_regs + SOURCE_Y, y0); |
138 | out_be16(fb_regs + DEST_X, x1); |
139 | out_be16(fb_regs + DEST_Y, y1); |
140 | out_be16(fb_regs + WWIDTH, w); |
141 | out_be16(fb_regs + WHEIGHT, h); |
142 | out_8(fb_regs + WMOVE, fb_bitmask); |
143 | } |
144 | |
145 | static void hpfb_copyarea(struct fb_info *info, const struct fb_copyarea *area) |
146 | { |
147 | topcat_blit(area->sx, area->sy, area->dx, area->dy, area->width, area->height, RR_COPY); |
148 | } |
149 | |
150 | static void hpfb_fillrect(struct fb_info *p, const struct fb_fillrect *region) |
151 | { |
152 | u8 clr; |
153 | |
154 | clr = region->color & 0xff; |
155 | |
156 | while (in_8(fb_regs + BUSY) & fb_bitmask) |
157 | ; |
158 | |
159 | /* Foreground */ |
160 | out_8(fb_regs + TC_WEN, fb_bitmask & clr); |
161 | out_8(fb_regs + WMRR, (region->rop == ROP_COPY ? RR_SET : RR_INVERT)); |
162 | |
163 | /* Background */ |
164 | out_8(fb_regs + TC_WEN, fb_bitmask & ~clr); |
165 | out_8(fb_regs + WMRR, (region->rop == ROP_COPY ? RR_CLEAR : RR_NOOP)); |
166 | |
167 | topcat_blit(region->dx, region->dy, region->dx, region->dy, region->width, region->height, -1); |
168 | } |
169 | |
170 | static int hpfb_sync(struct fb_info *info) |
171 | { |
172 | /* |
173 | * Since we also access the framebuffer directly, we have to wait |
174 | * until the block mover is finished |
175 | */ |
176 | while (in_8(fb_regs + BUSY) & fb_bitmask) |
177 | ; |
178 | |
179 | out_8(fb_regs + TC_WEN, fb_bitmask); |
180 | out_8(fb_regs + TC_PRR, RR_COPY); |
181 | out_8(fb_regs + TC_FBEN, fb_bitmask); |
182 | |
183 | return 0; |
184 | } |
185 | |
186 | static struct fb_ops hpfb_ops = { |
187 | .owner = THIS_MODULE, |
188 | .fb_setcolreg = hpfb_setcolreg, |
189 | .fb_blank = hpfb_blank, |
190 | .fb_fillrect = hpfb_fillrect, |
191 | .fb_copyarea = hpfb_copyarea, |
192 | .fb_imageblit = cfb_imageblit, |
193 | .fb_sync = hpfb_sync, |
194 | }; |
195 | |
196 | /* Common to all HP framebuffers */ |
197 | #define HPFB_FBWMSB 0x05 /* Frame buffer width */ |
198 | #define HPFB_FBWLSB 0x07 |
199 | #define HPFB_FBHMSB 0x09 /* Frame buffer height */ |
200 | #define HPFB_FBHLSB 0x0b |
201 | #define HPFB_DWMSB 0x0d /* Display width */ |
202 | #define HPFB_DWLSB 0x0f |
203 | #define HPFB_DHMSB 0x11 /* Display height */ |
204 | #define HPFB_DHLSB 0x13 |
205 | #define HPFB_NUMPLANES 0x5b /* Number of colour planes */ |
206 | #define HPFB_FBOMSB 0x5d /* Frame buffer offset */ |
207 | #define HPFB_FBOLSB 0x5f |
208 | |
209 | static int __devinit hpfb_init_one(unsigned long phys_base, |
210 | unsigned long virt_base) |
211 | { |
212 | unsigned long fboff, fb_width, fb_height, fb_start; |
213 | |
214 | fb_regs = virt_base; |
215 | fboff = (in_8(fb_regs + HPFB_FBOMSB) << 8) | in_8(fb_regs + HPFB_FBOLSB); |
216 | |
217 | fb_info.fix.smem_start = (in_8(fb_regs + fboff) << 16); |
218 | |
219 | if (phys_base >= DIOII_BASE) { |
220 | fb_info.fix.smem_start += phys_base; |
221 | } |
222 | |
223 | if (DIO_SECID(fb_regs) != DIO_ID2_TOPCAT) { |
224 | /* This is the magic incantation the HP X server uses to make Catseye boards work. */ |
225 | while (in_be16(fb_regs+0x4800) & 1) |
226 | ; |
227 | out_be16(fb_regs+0x4800, 0); /* Catseye status */ |
228 | out_be16(fb_regs+0x4510, 0); /* VB */ |
229 | out_be16(fb_regs+0x4512, 0); /* TCNTRL */ |
230 | out_be16(fb_regs+0x4514, 0); /* ACNTRL */ |
231 | out_be16(fb_regs+0x4516, 0); /* PNCNTRL */ |
232 | out_be16(fb_regs+0x4206, 0x90); /* RUG Command/Status */ |
233 | out_be16(fb_regs+0x60a2, 0); /* Overlay Mask */ |
234 | out_be16(fb_regs+0x60bc, 0); /* Ram Select */ |
235 | } |
236 | |
237 | /* |
238 | * Fill in the available video resolution |
239 | */ |
240 | fb_width = (in_8(fb_regs + HPFB_FBWMSB) << 8) | in_8(fb_regs + HPFB_FBWLSB); |
241 | fb_info.fix.line_length = fb_width; |
242 | fb_height = (in_8(fb_regs + HPFB_FBHMSB) << 8) | in_8(fb_regs + HPFB_FBHLSB); |
243 | fb_info.fix.smem_len = fb_width * fb_height; |
244 | fb_start = (unsigned long)ioremap_writethrough(fb_info.fix.smem_start, |
245 | fb_info.fix.smem_len); |
246 | hpfb_defined.xres = (in_8(fb_regs + HPFB_DWMSB) << 8) | in_8(fb_regs + HPFB_DWLSB); |
247 | hpfb_defined.yres = (in_8(fb_regs + HPFB_DHMSB) << 8) | in_8(fb_regs + HPFB_DHLSB); |
248 | hpfb_defined.xres_virtual = hpfb_defined.xres; |
249 | hpfb_defined.yres_virtual = hpfb_defined.yres; |
250 | hpfb_defined.bits_per_pixel = in_8(fb_regs + HPFB_NUMPLANES); |
251 | |
252 | printk(KERN_INFO "hpfb: framebuffer at 0x%lx, mapped to 0x%lx, size %dk\n", |
253 | fb_info.fix.smem_start, fb_start, fb_info.fix.smem_len/1024); |
254 | printk(KERN_INFO "hpfb: mode is %dx%dx%d, linelength=%d\n", |
255 | hpfb_defined.xres, hpfb_defined.yres, hpfb_defined.bits_per_pixel, fb_info.fix.line_length); |
256 | |
257 | /* |
258 | * Give the hardware a bit of a prod and work out how many bits per |
259 | * pixel are supported. |
260 | */ |
261 | out_8(fb_regs + TC_WEN, 0xff); |
262 | out_8(fb_regs + TC_PRR, RR_COPY); |
263 | out_8(fb_regs + TC_FBEN, 0xff); |
264 | out_8(fb_start, 0xff); |
265 | fb_bitmask = in_8(fb_start); |
266 | out_8(fb_start, 0); |
267 | |
268 | /* |
269 | * Enable reading/writing of all the planes. |
270 | */ |
271 | out_8(fb_regs + TC_WEN, fb_bitmask); |
272 | out_8(fb_regs + TC_PRR, RR_COPY); |
273 | out_8(fb_regs + TC_REN, fb_bitmask); |
274 | out_8(fb_regs + TC_FBEN, fb_bitmask); |
275 | |
276 | /* |
277 | * Clear the screen. |
278 | */ |
279 | topcat_blit(0, 0, 0, 0, fb_width, fb_height, RR_CLEAR); |
280 | |
281 | /* |
282 | * Let there be consoles.. |
283 | */ |
284 | if (DIO_SECID(fb_regs) == DIO_ID2_TOPCAT) |
285 | strcat(fb_info.fix.id, "Topcat"); |
286 | else |
287 | strcat(fb_info.fix.id, "Catseye"); |
288 | fb_info.fbops = &hpfb_ops; |
289 | fb_info.flags = FBINFO_DEFAULT; |
290 | fb_info.var = hpfb_defined; |
291 | fb_info.screen_base = (char *)fb_start; |
292 | |
293 | fb_alloc_cmap(&fb_info.cmap, 1 << hpfb_defined.bits_per_pixel, 0); |
294 | |
295 | if (register_framebuffer(&fb_info) < 0) { |
296 | fb_dealloc_cmap(&fb_info.cmap); |
297 | iounmap(fb_info.screen_base); |
298 | fb_info.screen_base = NULL; |
299 | return 1; |
300 | } |
301 | |
302 | printk(KERN_INFO "fb%d: %s frame buffer device\n", |
303 | fb_info.node, fb_info.fix.id); |
304 | |
305 | return 0; |
306 | } |
307 | |
308 | /* |
309 | * Check that the secondary ID indicates that we have some hope of working with this |
310 | * framebuffer. The catseye boards are pretty much like topcats and we can muddle through. |
311 | */ |
312 | |
313 | #define topcat_sid_ok(x) (((x) == DIO_ID2_LRCATSEYE) || ((x) == DIO_ID2_HRCCATSEYE) \ |
314 | || ((x) == DIO_ID2_HRMCATSEYE) || ((x) == DIO_ID2_TOPCAT)) |
315 | |
316 | /* |
317 | * Initialise the framebuffer |
318 | */ |
319 | static int __devinit hpfb_dio_probe(struct dio_dev * d, const struct dio_device_id * ent) |
320 | { |
321 | unsigned long paddr, vaddr; |
322 | |
323 | paddr = d->resource.start; |
324 | if (!request_mem_region(d->resource.start, d->resource.end - d->resource.start, d->name)) |
325 | return -EBUSY; |
326 | |
327 | if (d->scode >= DIOII_SCBASE) { |
328 | vaddr = (unsigned long)ioremap(paddr, d->resource.end - d->resource.start); |
329 | } else { |
330 | vaddr = paddr + DIO_VIRADDRBASE; |
331 | } |
332 | printk(KERN_INFO "Topcat found at DIO select code %d " |
333 | "(secondary id %02x)\n", d->scode, (d->id >> 8) & 0xff); |
334 | if (hpfb_init_one(paddr, vaddr)) { |
335 | if (d->scode >= DIOII_SCBASE) |
336 | iounmap((void *)vaddr); |
337 | return -ENOMEM; |
338 | } |
339 | return 0; |
340 | } |
341 | |
342 | static void __devexit hpfb_remove_one(struct dio_dev *d) |
343 | { |
344 | unregister_framebuffer(&fb_info); |
345 | if (d->scode >= DIOII_SCBASE) |
346 | iounmap((void *)fb_regs); |
347 | release_mem_region(d->resource.start, d->resource.end - d->resource.start); |
348 | } |
349 | |
350 | static struct dio_device_id hpfb_dio_tbl[] = { |
351 | { DIO_ENCODE_ID(DIO_ID_FBUFFER, DIO_ID2_LRCATSEYE) }, |
352 | { DIO_ENCODE_ID(DIO_ID_FBUFFER, DIO_ID2_HRCCATSEYE) }, |
353 | { DIO_ENCODE_ID(DIO_ID_FBUFFER, DIO_ID2_HRMCATSEYE) }, |
354 | { DIO_ENCODE_ID(DIO_ID_FBUFFER, DIO_ID2_TOPCAT) }, |
355 | { 0 } |
356 | }; |
357 | |
358 | static struct dio_driver hpfb_driver = { |
359 | .name = "hpfb", |
360 | .id_table = hpfb_dio_tbl, |
361 | .probe = hpfb_dio_probe, |
362 | .remove = __devexit_p(hpfb_remove_one), |
363 | }; |
364 | |
365 | int __init hpfb_init(void) |
366 | { |
367 | unsigned int sid; |
368 | mm_segment_t fs; |
369 | unsigned char i; |
370 | int err; |
371 | |
372 | /* Topcats can be on the internal IO bus or real DIO devices. |
373 | * The internal variant sits at 0x560000; it has primary |
374 | * and secondary ID registers just like the DIO version. |
375 | * So we merge the two detection routines. |
376 | * |
377 | * Perhaps this #define should be in a global header file: |
378 | * I believe it's common to all internal fbs, not just topcat. |
379 | */ |
380 | #define INTFBVADDR 0xf0560000 |
381 | #define INTFBPADDR 0x560000 |
382 | |
383 | if (!MACH_IS_HP300) |
384 | return -ENODEV; |
385 | |
386 | if (fb_get_options("hpfb", NULL)) |
387 | return -ENODEV; |
388 | |
389 | err = dio_register_driver(&hpfb_driver); |
390 | if (err) |
391 | return err; |
392 | |
393 | fs = get_fs(); |
394 | set_fs(KERNEL_DS); |
395 | err = get_user(i, (unsigned char *)INTFBVADDR + DIO_IDOFF); |
396 | set_fs(fs); |
397 | |
398 | if (!err && (i == DIO_ID_FBUFFER) && topcat_sid_ok(sid = DIO_SECID(INTFBVADDR))) { |
399 | if (!request_mem_region(INTFBPADDR, DIO_DEVSIZE, "Internal Topcat")) |
400 | return -EBUSY; |
401 | printk(KERN_INFO "Internal Topcat found (secondary id %02x)\n", sid); |
402 | if (hpfb_init_one(INTFBPADDR, INTFBVADDR)) { |
403 | return -ENOMEM; |
404 | } |
405 | } |
406 | return 0; |
407 | } |
408 | |
409 | void __exit hpfb_cleanup_module(void) |
410 | { |
411 | dio_unregister_driver(&hpfb_driver); |
412 | } |
413 | |
414 | module_init(hpfb_init); |
415 | module_exit(hpfb_cleanup_module); |
416 | |
417 | MODULE_LICENSE("GPL"); |
418 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9