|  | /* macfb.c: Generic framebuffer for Macs whose colourmaps/modes we | 
|  | don't know how to set */ | 
|  |  | 
|  | /* (c) 1999 David Huggins-Daines <dhd@debian.org> | 
|  |  | 
|  | Primarily based on vesafb.c, by Gerd Knorr | 
|  | (c) 1998 Gerd Knorr <kraxel@cs.tu-berlin.de> | 
|  |  | 
|  | Also uses information and code from: | 
|  |  | 
|  | The original macfb.c from Linux/mac68k 2.0, by Alan Cox, Juergen | 
|  | Mellinger, Mikael Forselius, Michael Schmitz, and others. | 
|  |  | 
|  | valkyriefb.c, by Martin Costabel, Kevin Schoedel, Barry Nathan, Dan | 
|  | Jacobowitz, Paul Mackerras, Fabio Riccardi, and Geert Uytterhoeven. | 
|  |  | 
|  | This code is free software.  You may copy, modify, and distribute | 
|  | it subject to the terms and conditions of the GNU General Public | 
|  | License, version 2, or any later version, at your convenience. */ | 
|  |  | 
|  | #include <linux/module.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/sched.h> | 
|  | #include <linux/errno.h> | 
|  | #include <linux/string.h> | 
|  | #include <linux/mm.h> | 
|  | #include <linux/tty.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/nubus.h> | 
|  | #include <linux/init.h> | 
|  | #include <linux/fb.h> | 
|  |  | 
|  | #include <asm/setup.h> | 
|  | #include <asm/bootinfo.h> | 
|  | #include <asm/uaccess.h> | 
|  | #include <asm/pgtable.h> | 
|  | #include <asm/irq.h> | 
|  | #include <asm/macintosh.h> | 
|  | #include <asm/io.h> | 
|  | #include <asm/machw.h> | 
|  |  | 
|  | /* Common DAC base address for the LC, RBV, Valkyrie, and IIvx */ | 
|  | #define DAC_BASE 0x50f24000 | 
|  |  | 
|  | /* Some addresses for the DAFB */ | 
|  | #define DAFB_BASE 0xf9800200 | 
|  |  | 
|  | /* Address for the built-in Civic framebuffer in Quadra AVs */ | 
|  | #define CIVIC_BASE 0x50f30800	/* Only tested on 660AV! */ | 
|  |  | 
|  | /* GSC (Gray Scale Controller) base address */ | 
|  | #define GSC_BASE 0x50F20000 | 
|  |  | 
|  | /* CSC (Color Screen Controller) base address */ | 
|  | #define CSC_BASE 0x50F20000 | 
|  |  | 
|  | static int (*macfb_setpalette) (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) = NULL; | 
|  | static int valkyrie_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info); | 
|  | static int dafb_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *fb_info); | 
|  | static int rbv_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *fb_info); | 
|  | static int mdc_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *fb_info); | 
|  | static int toby_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *fb_info); | 
|  | static int civic_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *fb_info); | 
|  | static int csc_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *fb_info); | 
|  |  | 
|  | static volatile struct { | 
|  | unsigned char addr; | 
|  | /* Note: word-aligned */ | 
|  | char pad[3]; | 
|  | unsigned char lut; | 
|  | } *valkyrie_cmap_regs; | 
|  |  | 
|  | static volatile struct { | 
|  | unsigned char addr; | 
|  | unsigned char lut; | 
|  | } *v8_brazil_cmap_regs; | 
|  |  | 
|  | static volatile struct { | 
|  | unsigned char addr; | 
|  | char pad1[3]; /* word aligned */ | 
|  | unsigned char lut; | 
|  | char pad2[3]; /* word aligned */ | 
|  | unsigned char cntl; /* a guess as to purpose */ | 
|  | } *rbv_cmap_regs; | 
|  |  | 
|  | static volatile struct { | 
|  | unsigned long reset; | 
|  | unsigned long pad1[3]; | 
|  | unsigned char pad2[3]; | 
|  | unsigned char lut; | 
|  | } *dafb_cmap_regs; | 
|  |  | 
|  | static volatile struct { | 
|  | unsigned char addr;	/* OFFSET: 0x00 */ | 
|  | unsigned char pad1[15]; | 
|  | unsigned char lut;	/* OFFSET: 0x10 */ | 
|  | unsigned char pad2[15]; | 
|  | unsigned char status;	/* OFFSET: 0x20 */ | 
|  | unsigned char pad3[7]; | 
|  | unsigned long vbl_addr;	/* OFFSET: 0x28 */ | 
|  | unsigned int  status2;	/* OFFSET: 0x2C */ | 
|  | } *civic_cmap_regs; | 
|  |  | 
|  | static volatile struct { | 
|  | char    pad1[0x40]; | 
|  | unsigned char	clut_waddr;	/* 0x40 */ | 
|  | char    pad2; | 
|  | unsigned char	clut_data;	/* 0x42 */ | 
|  | char	pad3[0x3]; | 
|  | unsigned char	clut_raddr;	/* 0x46 */ | 
|  | } *csc_cmap_regs; | 
|  |  | 
|  | /* We will leave these the way they are for the time being */ | 
|  | struct mdc_cmap_regs { | 
|  | char pad1[0x200200]; | 
|  | unsigned char addr; | 
|  | char pad2[6]; | 
|  | unsigned char lut; | 
|  | }; | 
|  |  | 
|  | struct toby_cmap_regs { | 
|  | char pad1[0x90018]; | 
|  | unsigned char lut; /* TFBClutWDataReg, offset 0x90018 */ | 
|  | char pad2[3]; | 
|  | unsigned char addr; /* TFBClutAddrReg, offset 0x9001C */ | 
|  | }; | 
|  |  | 
|  | struct jet_cmap_regs { | 
|  | char pad1[0xe0e000]; | 
|  | unsigned char addr; | 
|  | unsigned char lut; | 
|  | }; | 
|  |  | 
|  | #define PIXEL_TO_MM(a)	(((a)*10)/28)	/* width in mm at 72 dpi */ | 
|  |  | 
|  | /* mode */ | 
|  | static int  video_slot = 0; | 
|  |  | 
|  | static struct fb_var_screeninfo macfb_defined = { | 
|  | .bits_per_pixel	= 8, | 
|  | .activate	= FB_ACTIVATE_NOW, | 
|  | .width		= -1, | 
|  | .height		= -1, | 
|  | .right_margin	= 32, | 
|  | .upper_margin	= 16, | 
|  | .lower_margin	= 4, | 
|  | .vsync_len	= 4, | 
|  | .vmode		= FB_VMODE_NONINTERLACED, | 
|  | }; | 
|  |  | 
|  | static struct fb_fix_screeninfo macfb_fix = { | 
|  | .id	= "Macintosh ", | 
|  | .type	= FB_TYPE_PACKED_PIXELS, | 
|  | .accel	= FB_ACCEL_NONE, | 
|  | }; | 
|  |  | 
|  | static struct fb_info fb_info; | 
|  | static u32 pseudo_palette[17]; | 
|  | static int inverse   = 0; | 
|  | static int vidtest   = 0; | 
|  |  | 
|  | static int valkyrie_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | unsigned long flags; | 
|  |  | 
|  | red >>= 8; | 
|  | green >>= 8; | 
|  | blue >>= 8; | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | /* tell clut which address to fill */ | 
|  | nubus_writeb(regno, &valkyrie_cmap_regs->addr); | 
|  | nop(); | 
|  |  | 
|  | /* send one color channel at a time */ | 
|  | nubus_writeb(red, &valkyrie_cmap_regs->lut); | 
|  | nop(); | 
|  | nubus_writeb(green, &valkyrie_cmap_regs->lut); | 
|  | nop(); | 
|  | nubus_writeb(blue, &valkyrie_cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* Unlike the Valkyrie, the DAFB cannot set individual colormap | 
|  | registers.  Therefore, we do what the MacOS driver does (no | 
|  | kidding!) and simply set them one by one until we hit the one we | 
|  | want. */ | 
|  | static int dafb_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | /* FIXME: really, really need to use ioremap() here, | 
|  | phys_to_virt() doesn't work anymore */ | 
|  | static int lastreg = -1; | 
|  | unsigned long flags; | 
|  |  | 
|  | red >>= 8; | 
|  | green >>= 8; | 
|  | blue >>= 8; | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | /* fbdev will set an entire colourmap, but X won't.  Hopefully | 
|  | this should accommodate both of them */ | 
|  | if (regno != lastreg+1) { | 
|  | int i; | 
|  |  | 
|  | /* Stab in the dark trying to reset the CLUT pointer */ | 
|  | nubus_writel(0, &dafb_cmap_regs->reset); | 
|  | nop(); | 
|  |  | 
|  | /* Loop until we get to the register we want */ | 
|  | for (i = 0; i < regno; i++) { | 
|  | nubus_writeb(info->cmap.red[i] >> 8, &dafb_cmap_regs->lut); | 
|  | nop(); | 
|  | nubus_writeb(info->cmap.green[i] >> 8, &dafb_cmap_regs->lut); | 
|  | nop(); | 
|  | nubus_writeb(info->cmap.blue[i] >> 8, &dafb_cmap_regs->lut); | 
|  | nop(); | 
|  | } | 
|  | } | 
|  |  | 
|  | nubus_writeb(red, &dafb_cmap_regs->lut); | 
|  | nop(); | 
|  | nubus_writeb(green, &dafb_cmap_regs->lut); | 
|  | nop(); | 
|  | nubus_writeb(blue, &dafb_cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | lastreg = regno; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* V8 and Brazil seem to use the same DAC.  Sonora does as well. */ | 
|  | static int v8_brazil_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | unsigned int bpp = info->var.bits_per_pixel; | 
|  | unsigned char _red  =red>>8; | 
|  | unsigned char _green=green>>8; | 
|  | unsigned char _blue =blue>>8; | 
|  | unsigned char _regno; | 
|  | unsigned long flags; | 
|  |  | 
|  | if (bpp > 8) return 1; /* failsafe */ | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | /* On these chips, the CLUT register numbers are spread out | 
|  | across the register space.  Thus: | 
|  |  | 
|  | In 8bpp, all regnos are valid. | 
|  |  | 
|  | In 4bpp, the regnos are 0x0f, 0x1f, 0x2f, etc, etc | 
|  |  | 
|  | In 2bpp, the regnos are 0x3f, 0x7f, 0xbf, 0xff */ | 
|  | _regno = (regno << (8 - bpp)) | (0xFF >> bpp); | 
|  | nubus_writeb(_regno, &v8_brazil_cmap_regs->addr); nop(); | 
|  |  | 
|  | /* send one color channel at a time */ | 
|  | nubus_writeb(_red, &v8_brazil_cmap_regs->lut); nop(); | 
|  | nubus_writeb(_green, &v8_brazil_cmap_regs->lut); nop(); | 
|  | nubus_writeb(_blue, &v8_brazil_cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int rbv_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | /* use MSBs */ | 
|  | unsigned char _red  =red>>8; | 
|  | unsigned char _green=green>>8; | 
|  | unsigned char _blue =blue>>8; | 
|  | unsigned char _regno; | 
|  | unsigned long flags; | 
|  |  | 
|  | if (info->var.bits_per_pixel > 8) return 1; /* failsafe */ | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | /* From the VideoToolbox driver.  Seems to be saying that | 
|  | * regno #254 and #255 are the important ones for 1-bit color, | 
|  | * regno #252-255 are the important ones for 2-bit color, etc. | 
|  | */ | 
|  | _regno = regno + (256-(1 << info->var.bits_per_pixel)); | 
|  |  | 
|  | /* reset clut? (VideoToolbox sez "not necessary") */ | 
|  | nubus_writeb(0xFF, &rbv_cmap_regs->cntl); nop(); | 
|  |  | 
|  | /* tell clut which address to use. */ | 
|  | nubus_writeb(_regno, &rbv_cmap_regs->addr); nop(); | 
|  |  | 
|  | /* send one color channel at a time. */ | 
|  | nubus_writeb(_red,   &rbv_cmap_regs->lut); nop(); | 
|  | nubus_writeb(_green, &rbv_cmap_regs->lut); nop(); | 
|  | nubus_writeb(_blue,  &rbv_cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); /* done. */ | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* Macintosh Display Card (8x24) */ | 
|  | static int mdc_setpalette(unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | volatile struct mdc_cmap_regs *cmap_regs = | 
|  | nubus_slot_addr(video_slot); | 
|  | /* use MSBs */ | 
|  | unsigned char _red  =red>>8; | 
|  | unsigned char _green=green>>8; | 
|  | unsigned char _blue =blue>>8; | 
|  | unsigned char _regno=regno; | 
|  | unsigned long flags; | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | /* the nop's are there to order writes. */ | 
|  | nubus_writeb(_regno, &cmap_regs->addr); nop(); | 
|  | nubus_writeb(_red, &cmap_regs->lut);    nop(); | 
|  | nubus_writeb(_green, &cmap_regs->lut);  nop(); | 
|  | nubus_writeb(_blue, &cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* Toby frame buffer */ | 
|  | static int toby_setpalette(unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | volatile struct toby_cmap_regs *cmap_regs = | 
|  | nubus_slot_addr(video_slot); | 
|  | unsigned int bpp = info->var.bits_per_pixel; | 
|  | /* use MSBs */ | 
|  | unsigned char _red  =~(red>>8); | 
|  | unsigned char _green=~(green>>8); | 
|  | unsigned char _blue =~(blue>>8); | 
|  | unsigned char _regno = (regno << (8 - bpp)) | (0xFF >> bpp); | 
|  | unsigned long flags; | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | nubus_writeb(_regno, &cmap_regs->addr); nop(); | 
|  | nubus_writeb(_red, &cmap_regs->lut);    nop(); | 
|  | nubus_writeb(_green, &cmap_regs->lut);  nop(); | 
|  | nubus_writeb(_blue, &cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* Jet frame buffer */ | 
|  | static int jet_setpalette(unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | volatile struct jet_cmap_regs *cmap_regs = | 
|  | nubus_slot_addr(video_slot); | 
|  | /* use MSBs */ | 
|  | unsigned char _red   = (red>>8); | 
|  | unsigned char _green = (green>>8); | 
|  | unsigned char _blue  = (blue>>8); | 
|  | unsigned long flags; | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | nubus_writeb(regno, &cmap_regs->addr); nop(); | 
|  | nubus_writeb(_red, &cmap_regs->lut); nop(); | 
|  | nubus_writeb(_green, &cmap_regs->lut); nop(); | 
|  | nubus_writeb(_blue, &cmap_regs->lut); | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Civic framebuffer -- Quadra AV built-in video.  A chip | 
|  | * called Sebastian holds the actual color palettes, and | 
|  | * apparently, there are two different banks of 512K RAM | 
|  | * which can act as separate framebuffers for doing video | 
|  | * input and viewing the screen at the same time!  The 840AV | 
|  | * Can add another 1MB RAM to give the two framebuffers | 
|  | * 1MB RAM apiece. | 
|  | * | 
|  | * FIXME: this doesn't seem to work anymore. | 
|  | */ | 
|  | static int civic_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | static int lastreg = -1; | 
|  | unsigned long flags; | 
|  | int clut_status; | 
|  |  | 
|  | if (info->var.bits_per_pixel > 8) return 1; /* failsafe */ | 
|  |  | 
|  | red   >>= 8; | 
|  | green >>= 8; | 
|  | blue  >>= 8; | 
|  |  | 
|  | local_irq_save(flags); | 
|  |  | 
|  | /* | 
|  | * Set the register address | 
|  | */ | 
|  | nubus_writeb(regno, &civic_cmap_regs->addr); nop(); | 
|  |  | 
|  | /* | 
|  | * Wait for VBL interrupt here; | 
|  | * They're usually not enabled from Penguin, so we won't check | 
|  | */ | 
|  | #if 0 | 
|  | { | 
|  | #define CIVIC_VBL_OFFSET	0x120 | 
|  | volatile unsigned long *vbl = nubus_readl(civic_cmap_regs->vbl_addr + CIVIC_VBL_OFFSET); | 
|  | /* do interrupt setup stuff here? */ | 
|  | *vbl = 0L; nop();	/* clear */ | 
|  | *vbl = 1L; nop();	/* set */ | 
|  | while (*vbl != 0L)	/* wait for next vbl */ | 
|  | { | 
|  | usleep(10);	/* needed? */ | 
|  | } | 
|  | /* do interrupt shutdown stuff here? */ | 
|  | } | 
|  | #endif | 
|  |  | 
|  | /* | 
|  | * Grab a status word and do some checking; | 
|  | * Then finally write the clut! | 
|  | */ | 
|  | clut_status =  nubus_readb(&civic_cmap_regs->status2); | 
|  |  | 
|  | if ((clut_status & 0x0008) == 0) | 
|  | { | 
|  | #if 0 | 
|  | if ((clut_status & 0x000D) != 0) | 
|  | { | 
|  | nubus_writeb(0x00, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb(0x00, &civic_cmap_regs->lut); nop(); | 
|  | } | 
|  | #endif | 
|  |  | 
|  | nubus_writeb(  red, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb(green, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb( blue, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb( 0x00, &civic_cmap_regs->lut); nop(); | 
|  | } | 
|  | else | 
|  | { | 
|  | unsigned char junk; | 
|  |  | 
|  | junk = nubus_readb(&civic_cmap_regs->lut); nop(); | 
|  | junk = nubus_readb(&civic_cmap_regs->lut); nop(); | 
|  | junk = nubus_readb(&civic_cmap_regs->lut); nop(); | 
|  | junk = nubus_readb(&civic_cmap_regs->lut); nop(); | 
|  |  | 
|  | if ((clut_status & 0x000D) != 0) | 
|  | { | 
|  | nubus_writeb(0x00, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb(0x00, &civic_cmap_regs->lut); nop(); | 
|  | } | 
|  |  | 
|  | nubus_writeb(  red, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb(green, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb( blue, &civic_cmap_regs->lut); nop(); | 
|  | nubus_writeb( junk, &civic_cmap_regs->lut); nop(); | 
|  | } | 
|  |  | 
|  | local_irq_restore(flags); | 
|  | lastreg = regno; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * The CSC is the framebuffer on the PowerBook 190 series | 
|  | * (and the 5300 too, but that's a PowerMac). This function | 
|  | * brought to you in part by the ECSC driver for MkLinux. | 
|  | */ | 
|  |  | 
|  | static int csc_setpalette (unsigned int regno, unsigned int red, | 
|  | unsigned int green, unsigned int blue, | 
|  | struct fb_info *info) | 
|  | { | 
|  | mdelay(1); | 
|  | csc_cmap_regs->clut_waddr = regno; | 
|  | csc_cmap_regs->clut_data = red; | 
|  | csc_cmap_regs->clut_data = green; | 
|  | csc_cmap_regs->clut_data = blue; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int macfb_setcolreg(unsigned regno, unsigned red, unsigned green, | 
|  | unsigned blue, unsigned transp, | 
|  | struct fb_info *fb_info) | 
|  | { | 
|  | /* | 
|  | *  Set a single color register. The values supplied are | 
|  | *  already rounded down to the hardware's capabilities | 
|  | *  (according to the entries in the `var' structure). Return | 
|  | *  != 0 for invalid regno. | 
|  | */ | 
|  |  | 
|  | if (regno >= fb_info->cmap.len) | 
|  | return 1; | 
|  |  | 
|  | switch (fb_info->var.bits_per_pixel) { | 
|  | case 1: | 
|  | /* We shouldn't get here */ | 
|  | break; | 
|  | case 2: | 
|  | case 4: | 
|  | case 8: | 
|  | if (macfb_setpalette) | 
|  | macfb_setpalette(regno, red, green, blue, fb_info); | 
|  | else | 
|  | return 1; | 
|  | break; | 
|  | case 16: | 
|  | if (fb_info->var.red.offset == 10) { | 
|  | /* 1:5:5:5 */ | 
|  | ((u32*) (fb_info->pseudo_palette))[regno] = | 
|  | ((red   & 0xf800) >>  1) | | 
|  | ((green & 0xf800) >>  6) | | 
|  | ((blue  & 0xf800) >> 11) | | 
|  | ((transp != 0) << 15); | 
|  | } else { | 
|  | /* 0:5:6:5 */ | 
|  | ((u32*) (fb_info->pseudo_palette))[regno] = | 
|  | ((red   & 0xf800)      ) | | 
|  | ((green & 0xfc00) >>  5) | | 
|  | ((blue  & 0xf800) >> 11); | 
|  | } | 
|  | break; | 
|  | /* I'm pretty sure that one or the other of these | 
|  | doesn't exist on 68k Macs */ | 
|  | case 24: | 
|  | red   >>= 8; | 
|  | green >>= 8; | 
|  | blue  >>= 8; | 
|  | ((u32 *)(fb_info->pseudo_palette))[regno] = | 
|  | (red   << fb_info->var.red.offset)   | | 
|  | (green << fb_info->var.green.offset) | | 
|  | (blue  << fb_info->var.blue.offset); | 
|  | break; | 
|  | case 32: | 
|  | red   >>= 8; | 
|  | green >>= 8; | 
|  | blue  >>= 8; | 
|  | ((u32 *)(fb_info->pseudo_palette))[regno] = | 
|  | (red   << fb_info->var.red.offset)   | | 
|  | (green << fb_info->var.green.offset) | | 
|  | (blue  << fb_info->var.blue.offset); | 
|  | break; | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static struct fb_ops macfb_ops = { | 
|  | .owner		= THIS_MODULE, | 
|  | .fb_setcolreg	= macfb_setcolreg, | 
|  | .fb_fillrect	= cfb_fillrect, | 
|  | .fb_copyarea	= cfb_copyarea, | 
|  | .fb_imageblit	= cfb_imageblit, | 
|  | .fb_cursor	= soft_cursor, | 
|  | }; | 
|  |  | 
|  | void __init macfb_setup(char *options) | 
|  | { | 
|  | char *this_opt; | 
|  |  | 
|  | if (!options || !*options) | 
|  | return; | 
|  |  | 
|  | while ((this_opt = strsep(&options, ",")) != NULL) { | 
|  | if (!*this_opt) continue; | 
|  |  | 
|  | if (! strcmp(this_opt, "inverse")) | 
|  | inverse=1; | 
|  | /* This means "turn on experimental CLUT code" */ | 
|  | else if (!strcmp(this_opt, "vidtest")) | 
|  | vidtest=1; | 
|  | } | 
|  | } | 
|  |  | 
|  | void __init macfb_init(void) | 
|  | { | 
|  | int video_cmap_len, video_is_nubus = 0; | 
|  | struct nubus_dev* ndev = NULL; | 
|  | char *option = NULL; | 
|  |  | 
|  | if (fb_get_options("macfb", &option)) | 
|  | return -ENODEV; | 
|  | macfb_setup(option); | 
|  |  | 
|  | if (!MACH_IS_MAC) | 
|  | return; | 
|  |  | 
|  | /* There can only be one internal video controller anyway so | 
|  | we're not too worried about this */ | 
|  | macfb_defined.xres = mac_bi_data.dimensions & 0xFFFF; | 
|  | macfb_defined.yres = mac_bi_data.dimensions >> 16; | 
|  | macfb_defined.bits_per_pixel = mac_bi_data.videodepth; | 
|  | macfb_fix.line_length = mac_bi_data.videorow; | 
|  | macfb_fix.smem_len = macfb_fix.line_length * macfb_defined.yres; | 
|  | /* Note: physical address (since 2.1.127) */ | 
|  | macfb_fix.smem_start = mac_bi_data.videoaddr; | 
|  | /* This is actually redundant with the initial mappings. | 
|  | However, there are some non-obvious aspects to the way | 
|  | those mappings are set up, so this is in fact the safest | 
|  | way to ensure that this driver will work on every possible | 
|  | Mac */ | 
|  | fb_info.screen_base = ioremap(mac_bi_data.videoaddr, macfb_fix.smem_len); | 
|  |  | 
|  | printk("macfb: framebuffer at 0x%08lx, mapped to 0x%p, size %dk\n", | 
|  | macfb_fix.smem_start, fb_info.screen_base, macfb_fix.smem_len/1024); | 
|  | printk("macfb: mode is %dx%dx%d, linelength=%d\n", | 
|  | macfb_defined.xres, macfb_defined.yres, macfb_defined.bits_per_pixel, macfb_fix.line_length); | 
|  |  | 
|  | /* | 
|  | *	Fill in the available video resolution | 
|  | */ | 
|  |  | 
|  | macfb_defined.xres_virtual   = macfb_defined.xres; | 
|  | macfb_defined.yres_virtual   = macfb_defined.yres; | 
|  | macfb_defined.height = PIXEL_TO_MM(macfb_defined.yres); | 
|  | macfb_defined.width  = PIXEL_TO_MM(macfb_defined.xres); | 
|  |  | 
|  | printk("macfb: scrolling: redraw\n"); | 
|  | macfb_defined.yres_virtual = macfb_defined.yres; | 
|  |  | 
|  | /* some dummy values for timing to make fbset happy */ | 
|  | macfb_defined.pixclock     = 10000000 / macfb_defined.xres * 1000 / macfb_defined.yres; | 
|  | macfb_defined.left_margin  = (macfb_defined.xres / 8) & 0xf8; | 
|  | macfb_defined.hsync_len    = (macfb_defined.xres / 8) & 0xf8; | 
|  |  | 
|  | switch (macfb_defined.bits_per_pixel) { | 
|  | case 1: | 
|  | /* XXX: I think this will catch any program that tries | 
|  | to do FBIO_PUTCMAP when the visual is monochrome */ | 
|  | macfb_defined.red.length = macfb_defined.bits_per_pixel; | 
|  | macfb_defined.green.length = macfb_defined.bits_per_pixel; | 
|  | macfb_defined.blue.length = macfb_defined.bits_per_pixel; | 
|  | video_cmap_len = 0; | 
|  | macfb_fix.visual = FB_VISUAL_MONO01; | 
|  | break; | 
|  | case 2: | 
|  | case 4: | 
|  | case 8: | 
|  | macfb_defined.red.length = macfb_defined.bits_per_pixel; | 
|  | macfb_defined.green.length = macfb_defined.bits_per_pixel; | 
|  | macfb_defined.blue.length = macfb_defined.bits_per_pixel; | 
|  | video_cmap_len = 1 << macfb_defined.bits_per_pixel; | 
|  | macfb_fix.visual = FB_VISUAL_PSEUDOCOLOR; | 
|  | break; | 
|  | case 16: | 
|  | macfb_defined.transp.offset = 15; | 
|  | macfb_defined.transp.length = 1; | 
|  | macfb_defined.red.offset = 10; | 
|  | macfb_defined.red.length = 5; | 
|  | macfb_defined.green.offset = 5; | 
|  | macfb_defined.green.length = 5; | 
|  | macfb_defined.blue.offset = 0; | 
|  | macfb_defined.blue.length = 5; | 
|  | printk("macfb: directcolor: " | 
|  | "size=1:5:5:5, shift=15:10:5:0\n"); | 
|  | video_cmap_len = 16; | 
|  | /* Should actually be FB_VISUAL_DIRECTCOLOR, but this | 
|  | works too */ | 
|  | macfb_fix.visual = FB_VISUAL_TRUECOLOR; | 
|  | break; | 
|  | case 24: | 
|  | case 32: | 
|  | /* XXX: have to test these... can any 68k Macs | 
|  | actually do this on internal video? */ | 
|  | macfb_defined.red.offset = 16; | 
|  | macfb_defined.red.length = 8; | 
|  | macfb_defined.green.offset = 8; | 
|  | macfb_defined.green.length = 8; | 
|  | macfb_defined.blue.offset = 0; | 
|  | macfb_defined.blue.length = 8; | 
|  | printk("macfb: truecolor: " | 
|  | "size=0:8:8:8, shift=0:16:8:0\n"); | 
|  | video_cmap_len = 16; | 
|  | macfb_fix.visual = FB_VISUAL_TRUECOLOR; | 
|  | default: | 
|  | video_cmap_len = 0; | 
|  | macfb_fix.visual = FB_VISUAL_MONO01; | 
|  | printk("macfb: unknown or unsupported bit depth: %d\n", macfb_defined.bits_per_pixel); | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Hardware dependent stuff */ | 
|  | /*  We take a wild guess that if the video physical address is | 
|  | *  in nubus slot space, that the nubus card is driving video. | 
|  | *  Penguin really ought to tell us whether we are using internal | 
|  | *  video or not. | 
|  | */ | 
|  | /* Hopefully we only find one of them.  Otherwise our NuBus | 
|  | code is really broken :-) */ | 
|  |  | 
|  | while ((ndev = nubus_find_type(NUBUS_CAT_DISPLAY, NUBUS_TYPE_VIDEO, ndev)) | 
|  | != NULL) | 
|  | { | 
|  | if (!(mac_bi_data.videoaddr >= ndev->board->slot_addr | 
|  | && (mac_bi_data.videoaddr < | 
|  | (unsigned long)nubus_slot_addr(ndev->board->slot+1)))) | 
|  | continue; | 
|  | video_is_nubus = 1; | 
|  | /* We should probably just use the slot address... */ | 
|  | video_slot = ndev->board->slot; | 
|  |  | 
|  | switch(ndev->dr_hw) { | 
|  | case NUBUS_DRHW_APPLE_MDC: | 
|  | strcat( macfb_fix.id, "Display Card" ); | 
|  | macfb_setpalette = mdc_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | break; | 
|  | case NUBUS_DRHW_APPLE_TFB: | 
|  | strcat( macfb_fix.id, "Toby" ); | 
|  | macfb_setpalette = toby_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | break; | 
|  | case NUBUS_DRHW_APPLE_JET: | 
|  | strcat( macfb_fix.id, "Jet"); | 
|  | macfb_setpalette = jet_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | break; | 
|  | default: | 
|  | strcat( macfb_fix.id, "Generic NuBus" ); | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* If it's not a NuBus card, it must be internal video */ | 
|  | /* FIXME: this function is getting way too big.  (this driver | 
|  | is too...) */ | 
|  | if (!video_is_nubus) | 
|  | switch( mac_bi_data.id ) | 
|  | { | 
|  | /* These don't have onboard video.  Eventually, we may | 
|  | be able to write separate framebuffer drivers for | 
|  | them (tobyfb.c, hiresfb.c, etc, etc) */ | 
|  | case MAC_MODEL_II: | 
|  | case MAC_MODEL_IIX: | 
|  | case MAC_MODEL_IICX: | 
|  | case MAC_MODEL_IIFX: | 
|  | strcat( macfb_fix.id, "Generic NuBus" ); | 
|  | break; | 
|  |  | 
|  | /* Valkyrie Quadras */ | 
|  | case MAC_MODEL_Q630: | 
|  | /* I'm not sure about this one */ | 
|  | case MAC_MODEL_P588: | 
|  | strcat( macfb_fix.id, "Valkyrie built-in" ); | 
|  | macfb_setpalette = valkyrie_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | valkyrie_cmap_regs = ioremap(DAC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | /* DAFB Quadras */ | 
|  | /* Note: these first four have the v7 DAFB, which is | 
|  | known to be rather unlike the ones used in the | 
|  | other models */ | 
|  | case MAC_MODEL_P475: | 
|  | case MAC_MODEL_P475F: | 
|  | case MAC_MODEL_P575: | 
|  | case MAC_MODEL_Q605: | 
|  |  | 
|  | case MAC_MODEL_Q800: | 
|  | case MAC_MODEL_Q650: | 
|  | case MAC_MODEL_Q610: | 
|  | case MAC_MODEL_C650: | 
|  | case MAC_MODEL_C610: | 
|  | case MAC_MODEL_Q700: | 
|  | case MAC_MODEL_Q900: | 
|  | case MAC_MODEL_Q950: | 
|  | strcat( macfb_fix.id, "DAFB built-in" ); | 
|  | macfb_setpalette = dafb_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | dafb_cmap_regs = ioremap(DAFB_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | /* LC II uses the V8 framebuffer */ | 
|  | case MAC_MODEL_LCII: | 
|  | strcat( macfb_fix.id, "V8 built-in" ); | 
|  | macfb_setpalette = v8_brazil_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | v8_brazil_cmap_regs = ioremap(DAC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | /* IIvi, IIvx use the "Brazil" framebuffer (which is | 
|  | very much like the V8, it seems, and probably uses | 
|  | the same DAC) */ | 
|  | case MAC_MODEL_IIVI: | 
|  | case MAC_MODEL_IIVX: | 
|  | case MAC_MODEL_P600: | 
|  | strcat( macfb_fix.id, "Brazil built-in" ); | 
|  | macfb_setpalette = v8_brazil_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | v8_brazil_cmap_regs = ioremap(DAC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | /* LC III (and friends) use the Sonora framebuffer */ | 
|  | /* Incidentally this is also used in the non-AV models | 
|  | of the x100 PowerMacs */ | 
|  | /* These do in fact seem to use the same DAC interface | 
|  | as the LC II. */ | 
|  | case MAC_MODEL_LCIII: | 
|  | case MAC_MODEL_P520: | 
|  | case MAC_MODEL_P550: | 
|  | case MAC_MODEL_P460: | 
|  | macfb_setpalette = v8_brazil_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | strcat( macfb_fix.id, "Sonora built-in" ); | 
|  | v8_brazil_cmap_regs = ioremap(DAC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | /* IIci and IIsi use the infamous RBV chip | 
|  | (the IIsi is just a rebadged and crippled | 
|  | IIci in a different case, BTW) */ | 
|  | case MAC_MODEL_IICI: | 
|  | case MAC_MODEL_IISI: | 
|  | macfb_setpalette = rbv_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | strcat( macfb_fix.id, "RBV built-in" ); | 
|  | rbv_cmap_regs = ioremap(DAC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | /* AVs use the Civic framebuffer */ | 
|  | case MAC_MODEL_Q840: | 
|  | case MAC_MODEL_C660: | 
|  | macfb_setpalette = civic_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | strcat( macfb_fix.id, "Civic built-in" ); | 
|  | civic_cmap_regs = ioremap(CIVIC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  |  | 
|  | /* Write a setpalette function for your machine, then | 
|  | you can add something similar here.  These are | 
|  | grouped by classes of video chipsets.  Some of this | 
|  | information is from the VideoToolbox "Bugs" web | 
|  | page at | 
|  | http://rajsky.psych.nyu.edu/Tips/VideoBugs.html */ | 
|  |  | 
|  | /* Assorted weirdos */ | 
|  | /* We think this may be like the LC II */ | 
|  | case MAC_MODEL_LC: | 
|  | if (vidtest) { | 
|  | macfb_setpalette = v8_brazil_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | v8_brazil_cmap_regs = | 
|  | ioremap(DAC_BASE, 0x1000); | 
|  | } | 
|  | strcat( macfb_fix.id, "LC built-in" ); | 
|  | break; | 
|  | /* We think this may be like the LC II */ | 
|  | case MAC_MODEL_CCL: | 
|  | if (vidtest) { | 
|  | macfb_setpalette = v8_brazil_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | v8_brazil_cmap_regs = | 
|  | ioremap(DAC_BASE, 0x1000); | 
|  | } | 
|  | strcat( macfb_fix.id, "Color Classic built-in" ); | 
|  | break; | 
|  |  | 
|  | /* And we *do* mean "weirdos" */ | 
|  | case MAC_MODEL_TV: | 
|  | strcat( macfb_fix.id, "Mac TV built-in" ); | 
|  | break; | 
|  |  | 
|  | /* These don't have colour, so no need to worry */ | 
|  | case MAC_MODEL_SE30: | 
|  | case MAC_MODEL_CLII: | 
|  | strcat( macfb_fix.id, "Monochrome built-in" ); | 
|  | break; | 
|  |  | 
|  | /* Powerbooks are particularly difficult.  Many of | 
|  | them have separate framebuffers for external and | 
|  | internal video, which is admittedly pretty cool, | 
|  | but will be a bit of a headache to support here. | 
|  | Also, many of them are grayscale, and we don't | 
|  | really support that. */ | 
|  |  | 
|  | case MAC_MODEL_PB140: | 
|  | case MAC_MODEL_PB145: | 
|  | case MAC_MODEL_PB170: | 
|  | strcat( macfb_fix.id, "DDC built-in" ); | 
|  | break; | 
|  |  | 
|  | /* Internal is GSC, External (if present) is ViSC */ | 
|  | case MAC_MODEL_PB150:	/* no external video */ | 
|  | case MAC_MODEL_PB160: | 
|  | case MAC_MODEL_PB165: | 
|  | case MAC_MODEL_PB180: | 
|  | case MAC_MODEL_PB210: | 
|  | case MAC_MODEL_PB230: | 
|  | strcat( macfb_fix.id, "GSC built-in" ); | 
|  | break; | 
|  |  | 
|  | /* Internal is TIM, External is ViSC */ | 
|  | case MAC_MODEL_PB165C: | 
|  | case MAC_MODEL_PB180C: | 
|  | strcat( macfb_fix.id, "TIM built-in" ); | 
|  | break; | 
|  |  | 
|  | /* Internal is CSC, External is Keystone+Ariel. */ | 
|  | case MAC_MODEL_PB190:	/* external video is optional */ | 
|  | case MAC_MODEL_PB520: | 
|  | case MAC_MODEL_PB250: | 
|  | case MAC_MODEL_PB270C: | 
|  | case MAC_MODEL_PB280: | 
|  | case MAC_MODEL_PB280C: | 
|  | macfb_setpalette = csc_setpalette; | 
|  | macfb_defined.activate = FB_ACTIVATE_NOW; | 
|  | strcat( macfb_fix.id, "CSC built-in" ); | 
|  | csc_cmap_regs = ioremap(CSC_BASE, 0x1000); | 
|  | break; | 
|  |  | 
|  | default: | 
|  | strcat( macfb_fix.id, "Unknown/Unsupported built-in" ); | 
|  | break; | 
|  | } | 
|  |  | 
|  | fb_info.fbops		= &macfb_ops; | 
|  | fb_info.var		= macfb_defined; | 
|  | fb_info.fix		= macfb_fix; | 
|  | fb_info.pseudo_palette	= pseudo_palette; | 
|  | fb_info.flags		= FBINFO_DEFAULT; | 
|  |  | 
|  | fb_alloc_cmap(&fb_info.cmap, video_cmap_len, 0); | 
|  |  | 
|  | if (register_framebuffer(&fb_info) < 0) | 
|  | return; | 
|  |  | 
|  | printk("fb%d: %s frame buffer device\n", | 
|  | fb_info.node, fb_info.fix.id); | 
|  | } | 
|  |  | 
|  | module_init(macfb_init); | 
|  | MODULE_LICENSE("GPL"); |