cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

platinumfb.c (19884B)


      1/*
      2 *  platinumfb.c -- frame buffer device for the PowerMac 'platinum' display
      3 *
      4 *  Copyright (C) 1998 Franz Sirl
      5 *
      6 *  Frame buffer structure from:
      7 *    drivers/video/controlfb.c -- frame buffer device for
      8 *    Apple 'control' display chip.
      9 *    Copyright (C) 1998 Dan Jacobowitz
     10 *
     11 *  Hardware information from:
     12 *    platinum.c: Console support for PowerMac "platinum" display adaptor.
     13 *    Copyright (C) 1996 Paul Mackerras and Mark Abene
     14 *
     15 *  This file is subject to the terms and conditions of the GNU General Public
     16 *  License. See the file COPYING in the main directory of this archive for
     17 *  more details.
     18 */
     19
     20#undef DEBUG
     21
     22#include <linux/module.h>
     23#include <linux/kernel.h>
     24#include <linux/errno.h>
     25#include <linux/string.h>
     26#include <linux/mm.h>
     27#include <linux/vmalloc.h>
     28#include <linux/delay.h>
     29#include <linux/interrupt.h>
     30#include <linux/fb.h>
     31#include <linux/init.h>
     32#include <linux/nvram.h>
     33#include <linux/of_address.h>
     34#include <linux/of_device.h>
     35#include <linux/of_platform.h>
     36
     37#include "macmodes.h"
     38#include "platinumfb.h"
     39
     40static int default_vmode = VMODE_NVRAM;
     41static int default_cmode = CMODE_NVRAM;
     42
     43struct fb_info_platinum {
     44	struct fb_info			*info;
     45
     46	int				vmode, cmode;
     47	int				xres, yres;
     48	int				vxres, vyres;
     49	int				xoffset, yoffset;
     50
     51	struct {
     52		__u8 red, green, blue;
     53	}				palette[256];
     54	u32				pseudo_palette[16];
     55	
     56	volatile struct cmap_regs	__iomem *cmap_regs;
     57	unsigned long			cmap_regs_phys;
     58	
     59	volatile struct platinum_regs	__iomem *platinum_regs;
     60	unsigned long			platinum_regs_phys;
     61	
     62	__u8				__iomem *frame_buffer;
     63	volatile __u8			__iomem *base_frame_buffer;
     64	unsigned long			frame_buffer_phys;
     65	
     66	unsigned long			total_vram;
     67	int				clktype;
     68	int				dactype;
     69
     70	struct resource			rsrc_fb, rsrc_reg;
     71};
     72
     73/*
     74 * Frame buffer device API
     75 */
     76
     77static int platinumfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
     78	u_int transp, struct fb_info *info);
     79static int platinumfb_blank(int blank_mode, struct fb_info *info);
     80static int platinumfb_set_par (struct fb_info *info);
     81static int platinumfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info);
     82
     83/*
     84 * internal functions
     85 */
     86
     87static inline int platinum_vram_reqd(int video_mode, int color_mode);
     88static int read_platinum_sense(struct fb_info_platinum *pinfo);
     89static void set_platinum_clock(struct fb_info_platinum *pinfo);
     90static void platinum_set_hardware(struct fb_info_platinum *pinfo);
     91static int platinum_var_to_par(struct fb_var_screeninfo *var,
     92			       struct fb_info_platinum *pinfo,
     93			       int check_only);
     94
     95/*
     96 * Interface used by the world
     97 */
     98
     99static const struct fb_ops platinumfb_ops = {
    100	.owner =	THIS_MODULE,
    101	.fb_check_var	= platinumfb_check_var,
    102	.fb_set_par	= platinumfb_set_par,
    103	.fb_setcolreg	= platinumfb_setcolreg,
    104	.fb_blank	= platinumfb_blank,
    105	.fb_fillrect	= cfb_fillrect,
    106	.fb_copyarea	= cfb_copyarea,
    107	.fb_imageblit	= cfb_imageblit,
    108};
    109
    110/*
    111 * Checks a var structure
    112 */
    113static int platinumfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info)
    114{
    115	return platinum_var_to_par(var, info->par, 1);
    116}
    117
    118/*
    119 * Applies current var to display
    120 */
    121static int platinumfb_set_par (struct fb_info *info)
    122{
    123	struct fb_info_platinum *pinfo = info->par;
    124	struct platinum_regvals *init;
    125	int err, offset = 0x20;
    126
    127	if((err = platinum_var_to_par(&info->var, pinfo, 0))) {
    128		printk (KERN_ERR "platinumfb_set_par: error calling"
    129				 " platinum_var_to_par: %d.\n", err);
    130		return err;
    131	}
    132
    133	platinum_set_hardware(pinfo);
    134
    135	init = platinum_reg_init[pinfo->vmode-1];
    136	
    137 	if ((pinfo->vmode == VMODE_832_624_75) && (pinfo->cmode > CMODE_8))
    138  		offset = 0x10;
    139
    140	info->screen_base = pinfo->frame_buffer + init->fb_offset + offset;
    141	mutex_lock(&info->mm_lock);
    142	info->fix.smem_start = (pinfo->frame_buffer_phys) + init->fb_offset + offset;
    143	mutex_unlock(&info->mm_lock);
    144	info->fix.visual = (pinfo->cmode == CMODE_8) ?
    145		FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR;
    146 	info->fix.line_length = vmode_attrs[pinfo->vmode-1].hres * (1<<pinfo->cmode)
    147		+ offset;
    148	printk("line_length: %x\n", info->fix.line_length);
    149	return 0;
    150}
    151
    152static int platinumfb_blank(int blank,  struct fb_info *fb)
    153{
    154/*
    155 *  Blank the screen if blank_mode != 0, else unblank. If blank == NULL
    156 *  then the caller blanks by setting the CLUT (Color Look Up Table) to all
    157 *  black. Return 0 if blanking succeeded, != 0 if un-/blanking failed due
    158 *  to e.g. a video mode which doesn't support it. Implements VESA suspend
    159 *  and powerdown modes on hardware that supports disabling hsync/vsync:
    160 *    blank_mode == 2: suspend vsync
    161 *    blank_mode == 3: suspend hsync
    162 *    blank_mode == 4: powerdown
    163 */
    164/* [danj] I think there's something fishy about those constants... */
    165/*
    166	struct fb_info_platinum *info = (struct fb_info_platinum *) fb;
    167	int	ctrl;
    168
    169	ctrl = le32_to_cpup(&info->platinum_regs->ctrl.r) | 0x33;
    170	if (blank)
    171		--blank_mode;
    172	if (blank & VESA_VSYNC_SUSPEND)
    173		ctrl &= ~3;
    174	if (blank & VESA_HSYNC_SUSPEND)
    175		ctrl &= ~0x30;
    176	out_le32(&info->platinum_regs->ctrl.r, ctrl);
    177*/
    178/* TODO: Figure out how the heck to powerdown this thing! */
    179	return 0;
    180}
    181
    182static int platinumfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
    183			      u_int transp, struct fb_info *info)
    184{
    185	struct fb_info_platinum *pinfo = info->par;
    186	volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs;
    187
    188	if (regno > 255)
    189		return 1;
    190
    191	red >>= 8;
    192	green >>= 8;
    193	blue >>= 8;
    194
    195	pinfo->palette[regno].red = red;
    196	pinfo->palette[regno].green = green;
    197	pinfo->palette[regno].blue = blue;
    198
    199	out_8(&cmap_regs->addr, regno);		/* tell clut what addr to fill	*/
    200	out_8(&cmap_regs->lut, red);		/* send one color channel at	*/
    201	out_8(&cmap_regs->lut, green);		/* a time...			*/
    202	out_8(&cmap_regs->lut, blue);
    203
    204	if (regno < 16) {
    205		int i;
    206		u32 *pal = info->pseudo_palette;
    207		switch (pinfo->cmode) {
    208		case CMODE_16:
    209			pal[regno] = (regno << 10) | (regno << 5) | regno;
    210			break;
    211		case CMODE_32:
    212			i = (regno << 8) | regno;
    213			pal[regno] = (i << 16) | i;
    214			break;
    215		}
    216	}
    217	
    218	return 0;
    219}
    220
    221static inline int platinum_vram_reqd(int video_mode, int color_mode)
    222{
    223	int baseval = vmode_attrs[video_mode-1].hres * (1<<color_mode);
    224
    225	if ((video_mode == VMODE_832_624_75) && (color_mode > CMODE_8))
    226		baseval += 0x10;
    227	else
    228		baseval += 0x20;
    229
    230	return vmode_attrs[video_mode-1].vres * baseval + 0x1000;
    231}
    232
    233#define STORE_D2(a, d) { \
    234	out_8(&cmap_regs->addr, (a+32)); \
    235	out_8(&cmap_regs->d2, (d)); \
    236}
    237
    238static void set_platinum_clock(struct fb_info_platinum *pinfo)
    239{
    240	volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs;
    241	struct platinum_regvals	*init;
    242
    243	init = platinum_reg_init[pinfo->vmode-1];
    244
    245	STORE_D2(6, 0xc6);
    246	out_8(&cmap_regs->addr,3+32);
    247
    248	if (in_8(&cmap_regs->d2) == 2) {
    249		STORE_D2(7, init->clock_params[pinfo->clktype][0]);
    250		STORE_D2(8, init->clock_params[pinfo->clktype][1]);
    251		STORE_D2(3, 3);
    252	} else {
    253		STORE_D2(4, init->clock_params[pinfo->clktype][0]);
    254		STORE_D2(5, init->clock_params[pinfo->clktype][1]);
    255		STORE_D2(3, 2);
    256	}
    257
    258	__delay(5000);
    259	STORE_D2(9, 0xa6);
    260}
    261
    262
    263/* Now how about actually saying, Make it so! */
    264/* Some things in here probably don't need to be done each time. */
    265static void platinum_set_hardware(struct fb_info_platinum *pinfo)
    266{
    267	volatile struct platinum_regs	__iomem *platinum_regs = pinfo->platinum_regs;
    268	volatile struct cmap_regs	__iomem *cmap_regs = pinfo->cmap_regs;
    269	struct platinum_regvals		*init;
    270	int				i;
    271	int				vmode, cmode;
    272	
    273	vmode = pinfo->vmode;
    274	cmode = pinfo->cmode;
    275
    276	init = platinum_reg_init[vmode - 1];
    277
    278	/* Initialize display timing registers */
    279	out_be32(&platinum_regs->reg[24].r, 7);	/* turn display off */
    280
    281	for (i = 0; i < 26; ++i)
    282		out_be32(&platinum_regs->reg[i+32].r, init->regs[i]);
    283
    284	out_be32(&platinum_regs->reg[26+32].r, (pinfo->total_vram == 0x100000 ?
    285						init->offset[cmode] + 4 - cmode :
    286						init->offset[cmode]));
    287	out_be32(&platinum_regs->reg[16].r, (unsigned) pinfo->frame_buffer_phys+init->fb_offset+0x10);
    288	out_be32(&platinum_regs->reg[18].r, init->pitch[cmode]);
    289	out_be32(&platinum_regs->reg[19].r, (pinfo->total_vram == 0x100000 ?
    290					     init->mode[cmode+1] :
    291					     init->mode[cmode]));
    292	out_be32(&platinum_regs->reg[20].r, (pinfo->total_vram == 0x100000 ? 0x11 : 0x1011));
    293	out_be32(&platinum_regs->reg[21].r, 0x100);
    294	out_be32(&platinum_regs->reg[22].r, 1);
    295	out_be32(&platinum_regs->reg[23].r, 1);
    296	out_be32(&platinum_regs->reg[26].r, 0xc00);
    297	out_be32(&platinum_regs->reg[27].r, 0x235);
    298	/* out_be32(&platinum_regs->reg[27].r, 0x2aa); */
    299
    300	STORE_D2(0, (pinfo->total_vram == 0x100000 ?
    301		     init->dacula_ctrl[cmode] & 0xf :
    302		     init->dacula_ctrl[cmode]));
    303	STORE_D2(1, 4);
    304	STORE_D2(2, 0);
    305
    306	set_platinum_clock(pinfo);
    307
    308	out_be32(&platinum_regs->reg[24].r, 0);	/* turn display on */
    309}
    310
    311/*
    312 * Set misc info vars for this driver
    313 */
    314static void platinum_init_info(struct fb_info *info,
    315			       struct fb_info_platinum *pinfo)
    316{
    317	/* Fill fb_info */
    318	info->fbops = &platinumfb_ops;
    319	info->pseudo_palette = pinfo->pseudo_palette;
    320        info->flags = FBINFO_DEFAULT;
    321	info->screen_base = pinfo->frame_buffer + 0x20;
    322
    323	fb_alloc_cmap(&info->cmap, 256, 0);
    324
    325	/* Fill fix common fields */
    326	strcpy(info->fix.id, "platinum");
    327	info->fix.mmio_start = pinfo->platinum_regs_phys;
    328	info->fix.mmio_len = 0x1000;
    329	info->fix.type = FB_TYPE_PACKED_PIXELS;
    330	info->fix.smem_start = pinfo->frame_buffer_phys + 0x20; /* will be updated later */
    331	info->fix.smem_len = pinfo->total_vram - 0x20;
    332        info->fix.ywrapstep = 0;
    333	info->fix.xpanstep = 0;
    334	info->fix.ypanstep = 0;
    335        info->fix.type_aux = 0;
    336        info->fix.accel = FB_ACCEL_NONE;
    337}
    338
    339
    340static int platinum_init_fb(struct fb_info *info)
    341{
    342	struct fb_info_platinum *pinfo = info->par;
    343	struct fb_var_screeninfo var;
    344	int sense, rc;
    345
    346	sense = read_platinum_sense(pinfo);
    347	printk(KERN_INFO "platinumfb: Monitor sense value = 0x%x, ", sense);
    348
    349	if (IS_REACHABLE(CONFIG_NVRAM) && default_vmode == VMODE_NVRAM)
    350		default_vmode = nvram_read_byte(NV_VMODE);
    351	if (default_vmode <= 0 || default_vmode > VMODE_MAX ||
    352	    !platinum_reg_init[default_vmode - 1]) {
    353		default_vmode = mac_map_monitor_sense(sense);
    354		if (!platinum_reg_init[default_vmode - 1])
    355			default_vmode = VMODE_640_480_60;
    356	}
    357
    358	if (IS_REACHABLE(CONFIG_NVRAM) && default_cmode == CMODE_NVRAM)
    359		default_cmode = nvram_read_byte(NV_CMODE);
    360	if (default_cmode < CMODE_8 || default_cmode > CMODE_32)
    361		default_cmode = CMODE_8;
    362	/*
    363	 * Reduce the pixel size if we don't have enough VRAM.
    364	 */
    365	while(default_cmode > CMODE_8 &&
    366	      platinum_vram_reqd(default_vmode, default_cmode) > pinfo->total_vram)
    367		default_cmode--;
    368
    369	printk("platinumfb:  Using video mode %d and color mode %d.\n", default_vmode, default_cmode);
    370
    371	/* Setup default var */
    372	if (mac_vmode_to_var(default_vmode, default_cmode, &var) < 0) {
    373		/* This shouldn't happen! */
    374		printk("mac_vmode_to_var(%d, %d,) failed\n", default_vmode, default_cmode);
    375try_again:
    376		default_vmode = VMODE_640_480_60;
    377		default_cmode = CMODE_8;
    378		if (mac_vmode_to_var(default_vmode, default_cmode, &var) < 0) {
    379			printk(KERN_ERR "platinumfb: mac_vmode_to_var() failed\n");
    380			return -ENXIO;
    381		}
    382	}
    383
    384	/* Initialize info structure */
    385	platinum_init_info(info, pinfo);
    386
    387	/* Apply default var */
    388	info->var = var;
    389	var.activate = FB_ACTIVATE_NOW;
    390	rc = fb_set_var(info, &var);
    391	if (rc && (default_vmode != VMODE_640_480_60 || default_cmode != CMODE_8))
    392		goto try_again;
    393
    394	/* Register with fbdev layer */
    395	rc = register_framebuffer(info);
    396	if (rc < 0)
    397		return rc;
    398
    399	fb_info(info, "Apple Platinum frame buffer device\n");
    400
    401	return 0;
    402}
    403
    404/*
    405 * Get the monitor sense value.
    406 * Note that this can be called before calibrate_delay,
    407 * so we can't use udelay.
    408 */
    409static int read_platinum_sense(struct fb_info_platinum *info)
    410{
    411	volatile struct platinum_regs __iomem *platinum_regs = info->platinum_regs;
    412	int sense;
    413
    414	out_be32(&platinum_regs->reg[23].r, 7);	/* turn off drivers */
    415	__delay(2000);
    416	sense = (~in_be32(&platinum_regs->reg[23].r) & 7) << 8;
    417
    418	/* drive each sense line low in turn and collect the other 2 */
    419	out_be32(&platinum_regs->reg[23].r, 3);	/* drive A low */
    420	__delay(2000);
    421	sense |= (~in_be32(&platinum_regs->reg[23].r) & 3) << 4;
    422	out_be32(&platinum_regs->reg[23].r, 5);	/* drive B low */
    423	__delay(2000);
    424	sense |= (~in_be32(&platinum_regs->reg[23].r) & 4) << 1;
    425	sense |= (~in_be32(&platinum_regs->reg[23].r) & 1) << 2;
    426	out_be32(&platinum_regs->reg[23].r, 6);	/* drive C low */
    427	__delay(2000);
    428	sense |= (~in_be32(&platinum_regs->reg[23].r) & 6) >> 1;
    429
    430	out_be32(&platinum_regs->reg[23].r, 7);	/* turn off drivers */
    431
    432	return sense;
    433}
    434
    435/*
    436 * This routine takes a user-supplied var, and picks the best vmode/cmode from it.
    437 * It also updates the var structure to the actual mode data obtained
    438 */
    439static int platinum_var_to_par(struct fb_var_screeninfo *var, 
    440			       struct fb_info_platinum *pinfo,
    441			       int check_only)
    442{
    443	int vmode, cmode;
    444
    445	if (mac_var_to_vmode(var, &vmode, &cmode) != 0) {
    446		printk(KERN_ERR "platinum_var_to_par: mac_var_to_vmode unsuccessful.\n");
    447		printk(KERN_ERR "platinum_var_to_par: var->xres = %d\n", var->xres);
    448		printk(KERN_ERR "platinum_var_to_par: var->yres = %d\n", var->yres);
    449		printk(KERN_ERR "platinum_var_to_par: var->xres_virtual = %d\n", var->xres_virtual);
    450		printk(KERN_ERR "platinum_var_to_par: var->yres_virtual = %d\n", var->yres_virtual);
    451		printk(KERN_ERR "platinum_var_to_par: var->bits_per_pixel = %d\n", var->bits_per_pixel);
    452		printk(KERN_ERR "platinum_var_to_par: var->pixclock = %d\n", var->pixclock);
    453		printk(KERN_ERR "platinum_var_to_par: var->vmode = %d\n", var->vmode);
    454		return -EINVAL;
    455	}
    456
    457	if (!platinum_reg_init[vmode-1]) {
    458		printk(KERN_ERR "platinum_var_to_par, vmode %d not valid.\n", vmode);
    459		return -EINVAL;
    460	}
    461
    462	if (platinum_vram_reqd(vmode, cmode) > pinfo->total_vram) {
    463		printk(KERN_ERR "platinum_var_to_par, not enough ram for vmode %d, cmode %d.\n", vmode, cmode);
    464		return -EINVAL;
    465	}
    466
    467	if (mac_vmode_to_var(vmode, cmode, var))
    468		return -EINVAL;
    469
    470	if (check_only)
    471		return 0;
    472
    473	pinfo->vmode = vmode;
    474	pinfo->cmode = cmode;
    475	pinfo->xres = vmode_attrs[vmode-1].hres;
    476	pinfo->yres = vmode_attrs[vmode-1].vres;
    477	pinfo->xoffset = 0;
    478	pinfo->yoffset = 0;
    479	pinfo->vxres = pinfo->xres;
    480	pinfo->vyres = pinfo->yres;
    481	
    482	return 0;
    483}
    484
    485
    486/* 
    487 * Parse user specified options (`video=platinumfb:')
    488 */
    489static int __init platinumfb_setup(char *options)
    490{
    491	char *this_opt;
    492
    493	if (!options || !*options)
    494		return 0;
    495
    496	while ((this_opt = strsep(&options, ",")) != NULL) {
    497		if (!strncmp(this_opt, "vmode:", 6)) {
    498	    		int vmode = simple_strtoul(this_opt+6, NULL, 0);
    499			if (vmode > 0 && vmode <= VMODE_MAX)
    500				default_vmode = vmode;
    501		} else if (!strncmp(this_opt, "cmode:", 6)) {
    502			int depth = simple_strtoul(this_opt+6, NULL, 0);
    503			switch (depth) {
    504			 case 0:
    505			 case 8:
    506			    default_cmode = CMODE_8;
    507			    break;
    508			 case 15:
    509			 case 16:
    510			    default_cmode = CMODE_16;
    511			    break;
    512			 case 24:
    513			 case 32:
    514			    default_cmode = CMODE_32;
    515			    break;
    516			}
    517		}
    518	}
    519	return 0;
    520}
    521
    522#ifdef __powerpc__
    523#define invalidate_cache(addr) \
    524	asm volatile("eieio; dcbf 0,%1" \
    525	: "=m" (*(addr)) : "r" (addr) : "memory");
    526#else
    527#define invalidate_cache(addr)
    528#endif
    529
    530static int platinumfb_probe(struct platform_device* odev)
    531{
    532	struct device_node	*dp = odev->dev.of_node;
    533	struct fb_info		*info;
    534	struct fb_info_platinum	*pinfo;
    535	volatile __u8		*fbuffer;
    536	int			bank0, bank1, bank2, bank3, rc;
    537
    538	dev_info(&odev->dev, "Found Apple Platinum video hardware\n");
    539
    540	info = framebuffer_alloc(sizeof(*pinfo), &odev->dev);
    541	if (!info)
    542		return -ENOMEM;
    543
    544	pinfo = info->par;
    545
    546	if (of_address_to_resource(dp, 0, &pinfo->rsrc_reg) ||
    547	    of_address_to_resource(dp, 1, &pinfo->rsrc_fb)) {
    548		dev_err(&odev->dev, "Can't get resources\n");
    549		framebuffer_release(info);
    550		return -ENXIO;
    551	}
    552	dev_dbg(&odev->dev, " registers  : 0x%llx...0x%llx\n",
    553		(unsigned long long)pinfo->rsrc_reg.start,
    554		(unsigned long long)pinfo->rsrc_reg.end);
    555	dev_dbg(&odev->dev, " framebuffer: 0x%llx...0x%llx\n",
    556		(unsigned long long)pinfo->rsrc_fb.start,
    557		(unsigned long long)pinfo->rsrc_fb.end);
    558
    559	/* Do not try to request register space, they overlap with the
    560	 * northbridge and that can fail. Only request framebuffer
    561	 */
    562	if (!request_mem_region(pinfo->rsrc_fb.start,
    563				resource_size(&pinfo->rsrc_fb),
    564				"platinumfb framebuffer")) {
    565		printk(KERN_ERR "platinumfb: Can't request framebuffer !\n");
    566		framebuffer_release(info);
    567		return -ENXIO;
    568	}
    569
    570	/* frame buffer - map only 4MB */
    571	pinfo->frame_buffer_phys = pinfo->rsrc_fb.start;
    572	pinfo->frame_buffer = ioremap_wt(pinfo->rsrc_fb.start, 0x400000);
    573	pinfo->base_frame_buffer = pinfo->frame_buffer;
    574
    575	/* registers */
    576	pinfo->platinum_regs_phys = pinfo->rsrc_reg.start;
    577	pinfo->platinum_regs = ioremap(pinfo->rsrc_reg.start, 0x1000);
    578
    579	pinfo->cmap_regs_phys = 0xf301b000;	/* XXX not in prom? */
    580	request_mem_region(pinfo->cmap_regs_phys, 0x1000, "platinumfb cmap");
    581	pinfo->cmap_regs = ioremap(pinfo->cmap_regs_phys, 0x1000);
    582
    583	/* Grok total video ram */
    584	out_be32(&pinfo->platinum_regs->reg[16].r, (unsigned)pinfo->frame_buffer_phys);
    585	out_be32(&pinfo->platinum_regs->reg[20].r, 0x1011);	/* select max vram */
    586	out_be32(&pinfo->platinum_regs->reg[24].r, 0);	/* switch in vram */
    587
    588	fbuffer = pinfo->base_frame_buffer;
    589	fbuffer[0x100000] = 0x34;
    590	fbuffer[0x100008] = 0x0;
    591	invalidate_cache(&fbuffer[0x100000]);
    592	fbuffer[0x200000] = 0x56;
    593	fbuffer[0x200008] = 0x0;
    594	invalidate_cache(&fbuffer[0x200000]);
    595	fbuffer[0x300000] = 0x78;
    596	fbuffer[0x300008] = 0x0;
    597	invalidate_cache(&fbuffer[0x300000]);
    598	bank0 = 1; /* builtin 1MB vram, always there */
    599	bank1 = fbuffer[0x100000] == 0x34;
    600	bank2 = fbuffer[0x200000] == 0x56;
    601	bank3 = fbuffer[0x300000] == 0x78;
    602	pinfo->total_vram = (bank0 + bank1 + bank2 + bank3) * 0x100000;
    603	printk(KERN_INFO "platinumfb: Total VRAM = %dMB (%d%d%d%d)\n",
    604	       (unsigned int) (pinfo->total_vram / 1024 / 1024),
    605	       bank3, bank2, bank1, bank0);
    606
    607	/*
    608	 * Try to determine whether we have an old or a new DACula.
    609	 */
    610	out_8(&pinfo->cmap_regs->addr, 0x40);
    611	pinfo->dactype = in_8(&pinfo->cmap_regs->d2);
    612	switch (pinfo->dactype) {
    613	case 0x3c:
    614		pinfo->clktype = 1;
    615		printk(KERN_INFO "platinumfb: DACula type 0x3c\n");
    616		break;
    617	case 0x84:
    618		pinfo->clktype = 0;
    619		printk(KERN_INFO "platinumfb: DACula type 0x84\n");
    620		break;
    621	default:
    622		pinfo->clktype = 0;
    623		printk(KERN_INFO "platinumfb: Unknown DACula type: %x\n", pinfo->dactype);
    624		break;
    625	}
    626	dev_set_drvdata(&odev->dev, info);
    627	
    628	rc = platinum_init_fb(info);
    629	if (rc != 0) {
    630		iounmap(pinfo->frame_buffer);
    631		iounmap(pinfo->platinum_regs);
    632		iounmap(pinfo->cmap_regs);
    633		framebuffer_release(info);
    634	}
    635
    636	return rc;
    637}
    638
    639static int platinumfb_remove(struct platform_device* odev)
    640{
    641	struct fb_info		*info = dev_get_drvdata(&odev->dev);
    642	struct fb_info_platinum	*pinfo = info->par;
    643	
    644        unregister_framebuffer (info);
    645	
    646	/* Unmap frame buffer and registers */
    647	iounmap(pinfo->frame_buffer);
    648	iounmap(pinfo->platinum_regs);
    649	iounmap(pinfo->cmap_regs);
    650
    651	release_mem_region(pinfo->rsrc_fb.start,
    652			   resource_size(&pinfo->rsrc_fb));
    653
    654	release_mem_region(pinfo->cmap_regs_phys, 0x1000);
    655
    656	framebuffer_release(info);
    657
    658	return 0;
    659}
    660
    661static struct of_device_id platinumfb_match[] = 
    662{
    663	{
    664	.name 		= "platinum",
    665	},
    666	{},
    667};
    668
    669static struct platform_driver platinum_driver = 
    670{
    671	.driver = {
    672		.name = "platinumfb",
    673		.of_match_table = platinumfb_match,
    674	},
    675	.probe		= platinumfb_probe,
    676	.remove		= platinumfb_remove,
    677};
    678
    679static int __init platinumfb_init(void)
    680{
    681#ifndef MODULE
    682	char *option = NULL;
    683
    684	if (fb_get_options("platinumfb", &option))
    685		return -ENODEV;
    686	platinumfb_setup(option);
    687#endif
    688	platform_driver_register(&platinum_driver);
    689
    690	return 0;
    691}
    692
    693static void __exit platinumfb_exit(void)
    694{
    695	platform_driver_unregister(&platinum_driver);
    696}
    697
    698MODULE_LICENSE("GPL");
    699MODULE_DESCRIPTION("framebuffer driver for Apple Platinum video");
    700module_init(platinumfb_init);
    701
    702#ifdef MODULE
    703module_exit(platinumfb_exit);
    704#endif