2 * linux/drivers/video/offb.c -- Open Firmware based frame buffer device
4 * Copyright (C) 1997 Geert Uytterhoeven
6 * This driver is partly based on the PowerMac console driver:
8 * Copyright (C) 1996 Paul Mackerras
10 * This file is subject to the terms and conditions of the GNU General Public
11 * License. See the file COPYING in the main directory of this archive for
15 #include <linux/module.h>
16 #include <linux/kernel.h>
17 #include <linux/errno.h>
18 #include <linux/string.h>
20 #include <linux/slab.h>
21 #include <linux/vmalloc.h>
22 #include <linux/delay.h>
23 #include <linux/interrupt.h>
25 #include <linux/init.h>
26 #include <linux/ioport.h>
27 #include <linux/pci.h>
32 #include <asm/pci-bridge.h>
36 #include <asm/bootx.h>
41 /* Supported palette hacks */
44 cmap_m64
, /* ATI Mach64 */
45 cmap_r128
, /* ATI Rage128 */
46 cmap_M3A
, /* ATI Rage Mobility M3 Head A */
47 cmap_M3B
, /* ATI Rage Mobility M3 Head B */
48 cmap_radeon
, /* ATI Radeon */
49 cmap_gxt2000
, /* IBM GXT2000 */
50 cmap_avivo
, /* ATI R5xx */
54 volatile void __iomem
*cmap_adr
;
55 volatile void __iomem
*cmap_data
;
60 struct offb_par default_par
;
63 extern boot_infos_t
*boot_infos
;
66 /* Definitions used by the Avivo palette hack */
67 #define AVIVO_DC_LUT_RW_SELECT 0x6480
68 #define AVIVO_DC_LUT_RW_MODE 0x6484
69 #define AVIVO_DC_LUT_RW_INDEX 0x6488
70 #define AVIVO_DC_LUT_SEQ_COLOR 0x648c
71 #define AVIVO_DC_LUT_PWL_DATA 0x6490
72 #define AVIVO_DC_LUT_30_COLOR 0x6494
73 #define AVIVO_DC_LUT_READ_PIPE_SELECT 0x6498
74 #define AVIVO_DC_LUT_WRITE_EN_MASK 0x649c
75 #define AVIVO_DC_LUT_AUTOFILL 0x64a0
77 #define AVIVO_DC_LUTA_CONTROL 0x64c0
78 #define AVIVO_DC_LUTA_BLACK_OFFSET_BLUE 0x64c4
79 #define AVIVO_DC_LUTA_BLACK_OFFSET_GREEN 0x64c8
80 #define AVIVO_DC_LUTA_BLACK_OFFSET_RED 0x64cc
81 #define AVIVO_DC_LUTA_WHITE_OFFSET_BLUE 0x64d0
82 #define AVIVO_DC_LUTA_WHITE_OFFSET_GREEN 0x64d4
83 #define AVIVO_DC_LUTA_WHITE_OFFSET_RED 0x64d8
85 #define AVIVO_DC_LUTB_CONTROL 0x6cc0
86 #define AVIVO_DC_LUTB_BLACK_OFFSET_BLUE 0x6cc4
87 #define AVIVO_DC_LUTB_BLACK_OFFSET_GREEN 0x6cc8
88 #define AVIVO_DC_LUTB_BLACK_OFFSET_RED 0x6ccc
89 #define AVIVO_DC_LUTB_WHITE_OFFSET_BLUE 0x6cd0
90 #define AVIVO_DC_LUTB_WHITE_OFFSET_GREEN 0x6cd4
91 #define AVIVO_DC_LUTB_WHITE_OFFSET_RED 0x6cd8
94 * Set a single color register. The values supplied are already
95 * rounded down to the hardware's capabilities (according to the
96 * entries in the var structure). Return != 0 for invalid regno.
99 static int offb_setcolreg(u_int regno
, u_int red
, u_int green
, u_int blue
,
100 u_int transp
, struct fb_info
*info
)
102 struct offb_par
*par
= (struct offb_par
*) info
->par
;
104 u32
*pal
= info
->pseudo_palette
;
106 depth
= info
->var
.bits_per_pixel
;
108 depth
= (info
->var
.green
.length
== 5) ? 15 : 16;
111 (depth
== 16 && regno
> 63) ||
112 (depth
== 15 && regno
> 31))
118 pal
[regno
] = (regno
<< 10) | (regno
<< 5) | regno
;
121 pal
[regno
] = (regno
<< 11) | (regno
<< 5) | regno
;
124 pal
[regno
] = (regno
<< 16) | (regno
<< 8) | regno
;
127 i
= (regno
<< 8) | regno
;
128 pal
[regno
] = (i
<< 16) | i
;
140 switch (par
->cmap_type
) {
142 writeb(regno
, par
->cmap_adr
);
143 writeb(red
, par
->cmap_data
);
144 writeb(green
, par
->cmap_data
);
145 writeb(blue
, par
->cmap_data
);
148 /* Clear PALETTE_ACCESS_CNTL in DAC_CNTL */
149 out_le32(par
->cmap_adr
+ 0x58,
150 in_le32(par
->cmap_adr
+ 0x58) & ~0x20);
152 /* Set palette index & data */
153 out_8(par
->cmap_adr
+ 0xb0, regno
);
154 out_le32(par
->cmap_adr
+ 0xb4,
155 (red
<< 16 | green
<< 8 | blue
));
158 /* Set PALETTE_ACCESS_CNTL in DAC_CNTL */
159 out_le32(par
->cmap_adr
+ 0x58,
160 in_le32(par
->cmap_adr
+ 0x58) | 0x20);
161 /* Set palette index & data */
162 out_8(par
->cmap_adr
+ 0xb0, regno
);
163 out_le32(par
->cmap_adr
+ 0xb4, (red
<< 16 | green
<< 8 | blue
));
166 /* Set palette index & data (could be smarter) */
167 out_8(par
->cmap_adr
+ 0xb0, regno
);
168 out_le32(par
->cmap_adr
+ 0xb4, (red
<< 16 | green
<< 8 | blue
));
171 out_le32(((unsigned __iomem
*) par
->cmap_adr
) + regno
,
172 (red
<< 16 | green
<< 8 | blue
));
175 /* Write to both LUTs for now */
176 writel(1, par
->cmap_adr
+ AVIVO_DC_LUT_RW_SELECT
);
177 writeb(regno
, par
->cmap_adr
+ AVIVO_DC_LUT_RW_INDEX
);
178 writel(((red
) << 22) | ((green
) << 12) | ((blue
) << 2),
179 par
->cmap_adr
+ AVIVO_DC_LUT_30_COLOR
);
180 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_RW_SELECT
);
181 writeb(regno
, par
->cmap_adr
+ AVIVO_DC_LUT_RW_INDEX
);
182 writel(((red
) << 22) | ((green
) << 12) | ((blue
) << 2),
183 par
->cmap_adr
+ AVIVO_DC_LUT_30_COLOR
);
194 static int offb_blank(int blank
, struct fb_info
*info
)
196 struct offb_par
*par
= (struct offb_par
*) info
->par
;
206 par
->blanked
= blank
;
209 for (i
= 0; i
< 256; i
++) {
210 switch (par
->cmap_type
) {
212 writeb(i
, par
->cmap_adr
);
213 for (j
= 0; j
< 3; j
++)
214 writeb(0, par
->cmap_data
);
217 /* Clear PALETTE_ACCESS_CNTL in DAC_CNTL */
218 out_le32(par
->cmap_adr
+ 0x58,
219 in_le32(par
->cmap_adr
+ 0x58) & ~0x20);
221 /* Set palette index & data */
222 out_8(par
->cmap_adr
+ 0xb0, i
);
223 out_le32(par
->cmap_adr
+ 0xb4, 0);
226 /* Set PALETTE_ACCESS_CNTL in DAC_CNTL */
227 out_le32(par
->cmap_adr
+ 0x58,
228 in_le32(par
->cmap_adr
+ 0x58) | 0x20);
229 /* Set palette index & data */
230 out_8(par
->cmap_adr
+ 0xb0, i
);
231 out_le32(par
->cmap_adr
+ 0xb4, 0);
234 out_8(par
->cmap_adr
+ 0xb0, i
);
235 out_le32(par
->cmap_adr
+ 0xb4, 0);
238 out_le32(((unsigned __iomem
*) par
->cmap_adr
) + i
,
242 writel(1, par
->cmap_adr
+ AVIVO_DC_LUT_RW_SELECT
);
243 writeb(i
, par
->cmap_adr
+ AVIVO_DC_LUT_RW_INDEX
);
244 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_30_COLOR
);
245 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_RW_SELECT
);
246 writeb(i
, par
->cmap_adr
+ AVIVO_DC_LUT_RW_INDEX
);
247 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_30_COLOR
);
251 fb_set_cmap(&info
->cmap
, info
);
255 static int offb_set_par(struct fb_info
*info
)
257 struct offb_par
*par
= (struct offb_par
*) info
->par
;
259 /* On avivo, initialize palette control */
260 if (par
->cmap_type
== cmap_avivo
) {
261 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTA_CONTROL
);
262 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTA_BLACK_OFFSET_BLUE
);
263 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTA_BLACK_OFFSET_GREEN
);
264 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTA_BLACK_OFFSET_RED
);
265 writel(0x0000ffff, par
->cmap_adr
+ AVIVO_DC_LUTA_WHITE_OFFSET_BLUE
);
266 writel(0x0000ffff, par
->cmap_adr
+ AVIVO_DC_LUTA_WHITE_OFFSET_GREEN
);
267 writel(0x0000ffff, par
->cmap_adr
+ AVIVO_DC_LUTA_WHITE_OFFSET_RED
);
268 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTB_CONTROL
);
269 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTB_BLACK_OFFSET_BLUE
);
270 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTB_BLACK_OFFSET_GREEN
);
271 writel(0, par
->cmap_adr
+ AVIVO_DC_LUTB_BLACK_OFFSET_RED
);
272 writel(0x0000ffff, par
->cmap_adr
+ AVIVO_DC_LUTB_WHITE_OFFSET_BLUE
);
273 writel(0x0000ffff, par
->cmap_adr
+ AVIVO_DC_LUTB_WHITE_OFFSET_GREEN
);
274 writel(0x0000ffff, par
->cmap_adr
+ AVIVO_DC_LUTB_WHITE_OFFSET_RED
);
275 writel(1, par
->cmap_adr
+ AVIVO_DC_LUT_RW_SELECT
);
276 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_RW_MODE
);
277 writel(0x0000003f, par
->cmap_adr
+ AVIVO_DC_LUT_WRITE_EN_MASK
);
278 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_RW_SELECT
);
279 writel(0, par
->cmap_adr
+ AVIVO_DC_LUT_RW_MODE
);
280 writel(0x0000003f, par
->cmap_adr
+ AVIVO_DC_LUT_WRITE_EN_MASK
);
285 static struct fb_ops offb_ops
= {
286 .owner
= THIS_MODULE
,
287 .fb_setcolreg
= offb_setcolreg
,
288 .fb_set_par
= offb_set_par
,
289 .fb_blank
= offb_blank
,
290 .fb_fillrect
= cfb_fillrect
,
291 .fb_copyarea
= cfb_copyarea
,
292 .fb_imageblit
= cfb_imageblit
,
295 static void __iomem
*offb_map_reg(struct device_node
*np
, int index
,
296 unsigned long offset
, unsigned long size
)
302 addrp
= of_get_pci_address(np
, index
, &asize
, &flags
);
304 addrp
= of_get_address(np
, index
, &asize
, &flags
);
307 if ((flags
& (IORESOURCE_IO
| IORESOURCE_MEM
)) == 0)
309 if ((offset
+ size
) > asize
)
311 taddr
= of_translate_address(np
, addrp
);
312 if (taddr
== OF_BAD_ADDR
)
314 return ioremap(taddr
+ offset
, size
);
317 static void offb_init_palette_hacks(struct fb_info
*info
, struct device_node
*dp
,
318 const char *name
, unsigned long address
)
320 struct offb_par
*par
= (struct offb_par
*) info
->par
;
322 if (dp
&& !strncmp(name
, "ATY,Rage128", 11)) {
323 par
->cmap_adr
= offb_map_reg(dp
, 2, 0, 0x1fff);
325 par
->cmap_type
= cmap_r128
;
326 } else if (dp
&& (!strncmp(name
, "ATY,RageM3pA", 12)
327 || !strncmp(name
, "ATY,RageM3p12A", 14))) {
328 par
->cmap_adr
= offb_map_reg(dp
, 2, 0, 0x1fff);
330 par
->cmap_type
= cmap_M3A
;
331 } else if (dp
&& !strncmp(name
, "ATY,RageM3pB", 12)) {
332 par
->cmap_adr
= offb_map_reg(dp
, 2, 0, 0x1fff);
334 par
->cmap_type
= cmap_M3B
;
335 } else if (dp
&& !strncmp(name
, "ATY,Rage6", 9)) {
336 par
->cmap_adr
= offb_map_reg(dp
, 1, 0, 0x1fff);
338 par
->cmap_type
= cmap_radeon
;
339 } else if (!strncmp(name
, "ATY,", 4)) {
340 unsigned long base
= address
& 0xff000000UL
;
342 ioremap(base
+ 0x7ff000, 0x1000) + 0xcc0;
343 par
->cmap_data
= par
->cmap_adr
+ 1;
344 par
->cmap_type
= cmap_m64
;
345 } else if (dp
&& (of_device_is_compatible(dp
, "pci1014,b7") ||
346 of_device_is_compatible(dp
, "pci1014,21c"))) {
347 par
->cmap_adr
= offb_map_reg(dp
, 0, 0x6000, 0x1000);
349 par
->cmap_type
= cmap_gxt2000
;
350 } else if (dp
&& !strncmp(name
, "vga,Display-", 12)) {
351 /* Look for AVIVO initialized by SLOF */
352 struct device_node
*pciparent
= of_get_parent(dp
);
353 const u32
*vid
, *did
;
354 vid
= of_get_property(pciparent
, "vendor-id", NULL
);
355 did
= of_get_property(pciparent
, "device-id", NULL
);
356 /* This will match most R5xx */
357 if (vid
&& did
&& *vid
== 0x1002 &&
358 ((*did
>= 0x7100 && *did
< 0x7800) ||
360 par
->cmap_adr
= offb_map_reg(pciparent
, 2, 0, 0x10000);
362 par
->cmap_type
= cmap_avivo
;
364 of_node_put(pciparent
);
366 info
->fix
.visual
= (par
->cmap_type
!= cmap_unknown
) ?
367 FB_VISUAL_PSEUDOCOLOR
: FB_VISUAL_STATIC_PSEUDOCOLOR
;
370 static void __init
offb_init_fb(const char *name
, const char *full_name
,
371 int width
, int height
, int depth
,
372 int pitch
, unsigned long address
,
373 int foreign_endian
, struct device_node
*dp
)
375 unsigned long res_size
= pitch
* height
* (depth
+ 7) / 8;
376 struct offb_par
*par
= &default_par
;
377 unsigned long res_start
= address
;
378 struct fb_fix_screeninfo
*fix
;
379 struct fb_var_screeninfo
*var
;
380 struct fb_info
*info
;
383 if (!request_mem_region(res_start
, res_size
, "offb"))
387 "Using unsupported %dx%d %s at %lx, depth=%d, pitch=%d\n",
388 width
, height
, name
, address
, depth
, pitch
);
389 if (depth
!= 8 && depth
!= 15 && depth
!= 16 && depth
!= 32) {
390 printk(KERN_ERR
"%s: can't use depth = %d\n", full_name
,
392 release_mem_region(res_start
, res_size
);
396 size
= sizeof(struct fb_info
) + sizeof(u32
) * 16;
398 info
= kmalloc(size
, GFP_ATOMIC
);
401 release_mem_region(res_start
, res_size
);
404 memset(info
, 0, size
);
410 strcpy(fix
->id
, "OFfb ");
411 strncat(fix
->id
, name
, sizeof(fix
->id
) - sizeof("OFfb "));
412 fix
->id
[sizeof(fix
->id
) - 1] = '\0';
414 var
->xres
= var
->xres_virtual
= width
;
415 var
->yres
= var
->yres_virtual
= height
;
416 fix
->line_length
= pitch
;
418 fix
->smem_start
= address
;
419 fix
->smem_len
= pitch
* height
;
420 fix
->type
= FB_TYPE_PACKED_PIXELS
;
423 par
->cmap_type
= cmap_unknown
;
425 offb_init_palette_hacks(info
, dp
, name
, address
);
427 fix
->visual
= FB_VISUAL_TRUECOLOR
;
429 var
->xoffset
= var
->yoffset
= 0;
432 var
->bits_per_pixel
= 8;
435 var
->green
.offset
= 0;
436 var
->green
.length
= 8;
437 var
->blue
.offset
= 0;
438 var
->blue
.length
= 8;
439 var
->transp
.offset
= 0;
440 var
->transp
.length
= 0;
442 case 15: /* RGB 555 */
443 var
->bits_per_pixel
= 16;
444 var
->red
.offset
= 10;
446 var
->green
.offset
= 5;
447 var
->green
.length
= 5;
448 var
->blue
.offset
= 0;
449 var
->blue
.length
= 5;
450 var
->transp
.offset
= 0;
451 var
->transp
.length
= 0;
453 case 16: /* RGB 565 */
454 var
->bits_per_pixel
= 16;
455 var
->red
.offset
= 11;
457 var
->green
.offset
= 5;
458 var
->green
.length
= 6;
459 var
->blue
.offset
= 0;
460 var
->blue
.length
= 5;
461 var
->transp
.offset
= 0;
462 var
->transp
.length
= 0;
464 case 32: /* RGB 888 */
465 var
->bits_per_pixel
= 32;
466 var
->red
.offset
= 16;
468 var
->green
.offset
= 8;
469 var
->green
.length
= 8;
470 var
->blue
.offset
= 0;
471 var
->blue
.length
= 8;
472 var
->transp
.offset
= 24;
473 var
->transp
.length
= 8;
476 var
->red
.msb_right
= var
->green
.msb_right
= var
->blue
.msb_right
=
477 var
->transp
.msb_right
= 0;
481 var
->height
= var
->width
= -1;
482 var
->pixclock
= 10000;
483 var
->left_margin
= var
->right_margin
= 16;
484 var
->upper_margin
= var
->lower_margin
= 16;
485 var
->hsync_len
= var
->vsync_len
= 8;
487 var
->vmode
= FB_VMODE_NONINTERLACED
;
489 info
->fbops
= &offb_ops
;
490 info
->screen_base
= ioremap(address
, fix
->smem_len
);
491 info
->pseudo_palette
= (void *) (info
+ 1);
492 info
->flags
= FBINFO_DEFAULT
| foreign_endian
;
494 fb_alloc_cmap(&info
->cmap
, 256, 0);
496 if (register_framebuffer(info
) < 0) {
497 iounmap(par
->cmap_adr
);
498 par
->cmap_adr
= NULL
;
499 iounmap(info
->screen_base
);
501 release_mem_region(res_start
, res_size
);
505 printk(KERN_INFO
"fb%d: Open Firmware frame buffer device on %s\n",
506 info
->node
, full_name
);
510 static void __init
offb_init_nodriver(struct device_node
*dp
, int no_real_node
)
513 int i
, width
= 640, height
= 480, depth
= 8, pitch
= 640;
514 unsigned int flags
, rsize
, addr_prop
= 0;
515 unsigned long max_size
= 0;
516 u64 rstart
, address
= OF_BAD_ADDR
;
517 const u32
*pp
, *addrp
, *up
;
519 int foreign_endian
= 0;
522 if (of_get_property(dp
, "little-endian", NULL
))
523 foreign_endian
= FBINFO_FOREIGN_ENDIAN
;
525 if (of_get_property(dp
, "big-endian", NULL
))
526 foreign_endian
= FBINFO_FOREIGN_ENDIAN
;
529 pp
= of_get_property(dp
, "linux,bootx-depth", &len
);
531 pp
= of_get_property(dp
, "depth", &len
);
532 if (pp
&& len
== sizeof(u32
))
535 pp
= of_get_property(dp
, "linux,bootx-width", &len
);
537 pp
= of_get_property(dp
, "width", &len
);
538 if (pp
&& len
== sizeof(u32
))
541 pp
= of_get_property(dp
, "linux,bootx-height", &len
);
543 pp
= of_get_property(dp
, "height", &len
);
544 if (pp
&& len
== sizeof(u32
))
547 pp
= of_get_property(dp
, "linux,bootx-linebytes", &len
);
549 pp
= of_get_property(dp
, "linebytes", &len
);
550 if (pp
&& len
== sizeof(u32
) && (*pp
!= 0xffffffffu
))
553 pitch
= width
* ((depth
+ 7) / 8);
555 rsize
= (unsigned long)pitch
* (unsigned long)height
;
557 /* Ok, now we try to figure out the address of the framebuffer.
559 * Unfortunately, Open Firmware doesn't provide a standard way to do
560 * so. All we can do is a dodgy heuristic that happens to work in
561 * practice. On most machines, the "address" property contains what
562 * we need, though not on Matrox cards found in IBM machines. What I've
563 * found that appears to give good results is to go through the PCI
564 * ranges and pick one that is both big enough and if possible encloses
565 * the "address" property. If none match, we pick the biggest
567 up
= of_get_property(dp
, "linux,bootx-addr", &len
);
569 up
= of_get_property(dp
, "address", &len
);
570 if (up
&& len
== sizeof(u32
))
573 /* Hack for when BootX is passing us */
577 for (i
= 0; (addrp
= of_get_address(dp
, i
, &asize
, &flags
))
581 if (!(flags
& IORESOURCE_MEM
))
585 rstart
= of_translate_address(dp
, addrp
);
586 if (rstart
== OF_BAD_ADDR
)
588 if (addr_prop
&& (rstart
<= addr_prop
) &&
589 ((rstart
+ asize
) >= (addr_prop
+ rsize
)))
595 if (rsize
> max_size
) {
597 address
= OF_BAD_ADDR
;
600 if (address
== OF_BAD_ADDR
)
604 if (address
== OF_BAD_ADDR
&& addr_prop
)
605 address
= (u64
)addr_prop
;
606 if (address
!= OF_BAD_ADDR
) {
607 /* kludge for valkyrie */
608 if (strcmp(dp
->name
, "valkyrie") == 0)
610 offb_init_fb(no_real_node
? "bootx" : dp
->name
,
611 no_real_node
? "display" : dp
->full_name
,
612 width
, height
, depth
, pitch
, address
,
613 foreign_endian
, no_real_node
? NULL
: dp
);
617 static int __init
offb_init(void)
619 struct device_node
*dp
= NULL
, *boot_disp
= NULL
;
621 if (fb_get_options("offb", NULL
))
624 /* Check if we have a MacOS display without a node spec */
625 if (of_get_property(of_chosen
, "linux,bootx-noscreen", NULL
) != NULL
) {
626 /* The old code tried to work out which node was the MacOS
627 * display based on the address. I'm dropping that since the
628 * lack of a node spec only happens with old BootX versions
629 * (users can update) and with this code, they'll still get
630 * a display (just not the palette hacks).
632 offb_init_nodriver(of_chosen
, 1);
635 for (dp
= NULL
; (dp
= of_find_node_by_type(dp
, "display"));) {
636 if (of_get_property(dp
, "linux,opened", NULL
) &&
637 of_get_property(dp
, "linux,boot-display", NULL
)) {
639 offb_init_nodriver(dp
, 0);
642 for (dp
= NULL
; (dp
= of_find_node_by_type(dp
, "display"));) {
643 if (of_get_property(dp
, "linux,opened", NULL
) &&
645 offb_init_nodriver(dp
, 0);
652 module_init(offb_init
);
653 MODULE_LICENSE("GPL");