/* *  valkyriefb.c -- frame buffer device for the PowerMac 'valkyrie' display * *  Created 8 August 1998 by  *  Martin Costabel <costabel@wanadoo.fr> and Kevin Schoedel * *  Vmode-switching changes and vmode 15/17 modifications created 29 August *  1998 by Barry K. Nathan <barryn@pobox.com>. * *  Ported to m68k Macintosh by David Huggins-Daines <dhd@debian.org> * *  Derived directly from: * *   controlfb.c -- frame buffer device for the PowerMac 'control' display *   Copyright (C) 1998 Dan Jacobowitz <dan@debian.org> * *   pmc-valkyrie.c -- Console support for PowerMac "valkyrie" display adaptor. *   Copyright (C) 1997 Paul Mackerras. * *  and indirectly: * *  Frame buffer structure from: *    drivers/video/chipsfb.c -- frame buffer device for *    Chips & Technologies 65550 chip. * *    Copyright (C) 1998 Paul Mackerras * *    This file is derived from the Powermac "chips" driver: *    Copyright (C) 1997 Fabio Riccardi. *    And from the frame buffer device for Open Firmware-initialized devices: *    Copyright (C) 1997 Geert Uytterhoeven. * *  Hardware information from: *    control.c: Console support for PowerMac "control" display adaptor. *    Copyright (C) 1996 Paul Mackerras * *  This file is subject to the terms and conditions of the GNU General Public *  License. See the file COPYING in the main directory of this archive for *  more details. */#include <linux/config.h>#include <linux/module.h>#include <linux/kernel.h>#include <linux/errno.h>#include <linux/string.h>#include <linux/mm.h>#include <linux/tty.h>#include <linux/slab.h>#include <linux/vmalloc.h>#include <linux/delay.h>#include <linux/interrupt.h>#include <linux/fb.h>#include <linux/selection.h>#include <linux/init.h>#include <linux/pci.h>#include <linux/nvram.h>#ifdef CONFIG_FB_COMPAT_XPMAC#include <asm/vc_ioctl.h>#endif#include <linux/adb.h>#include <linux/cuda.h>#include <asm/io.h>#ifdef CONFIG_MAC#include <asm/bootinfo.h>#include <asm/macintosh.h>#else#include <asm/prom.h>#endif#include <asm/pgtable.h>#include <video/fbcon.h>#include <video/fbcon-cfb8.h>#include <video/fbcon-cfb16.h>#include <video/macmodes.h>#include "valkyriefb.h"static int can_soft_blank = 1;#ifdef CONFIG_MAC/* We don't yet have functions to read the PRAM... perhaps we can   adapt them from the PPC code? */static int default_vmode = VMODE_640_480_67;static int default_cmode = CMODE_8;#elsestatic int default_vmode = VMODE_NVRAM;static int default_cmode = CMODE_NVRAM;#endifstatic char fontname[40] __initdata = { 0 };static int currcon = 0;static int switching = 0;struct fb_par_valkyrie {	int	vmode, cmode;	int	xres, yres;	int	vxres, vyres;	int	xoffset, yoffset;};struct fb_info_valkyrie {	struct fb_info			info;	struct fb_fix_screeninfo	fix;	struct fb_var_screeninfo	var;	struct display			disp;	struct fb_par_valkyrie		par;	struct {	    __u8 red, green, blue;	}			palette[256];		struct cmap_regs	*cmap_regs;	unsigned long		cmap_regs_phys;		struct valkyrie_regs	*valkyrie_regs;	unsigned long		valkyrie_regs_phys;		__u8			*frame_buffer;	unsigned long		frame_buffer_phys;		int			sense;	unsigned long		total_vram;#ifdef FBCON_HAS_CFB16	u16 fbcon_cfb16_cmap[16];#endif};/* * Exported functions */int valkyriefb_init(void);int valkyriefb_setup(char*);static int valkyrie_get_fix(struct fb_fix_screeninfo *fix, int con,			 struct fb_info *info);static int valkyrie_get_var(struct fb_var_screeninfo *var, int con,			 struct fb_info *info);static int valkyrie_set_var(struct fb_var_screeninfo *var, int con,			 struct fb_info *info);static int valkyrie_get_cmap(struct fb_cmap *cmap, int kspc, int con,			  struct fb_info *info);static int valkyrie_set_cmap(struct fb_cmap *cmap, int kspc, int con,			  struct fb_info *info);static int read_valkyrie_sense(struct fb_info_valkyrie *p);static inline int valkyrie_vram_reqd(int video_mode, int color_mode);static void set_valkyrie_clock(unsigned char *params);static void valkyrie_set_par(const struct fb_par_valkyrie *p, struct fb_info_valkyrie *info);static inline int valkyrie_par_to_var(struct fb_par_valkyrie *par, struct fb_var_screeninfo *var);static int valkyrie_var_to_par(struct fb_var_screeninfo *var,	struct fb_par_valkyrie *par, const struct fb_info *fb_info);static void valkyrie_init_info(struct fb_info *info, struct fb_info_valkyrie *p);static void valkyrie_par_to_display(struct fb_par_valkyrie *par,  struct display *disp, struct fb_fix_screeninfo *fix, struct fb_info_valkyrie *p);static void valkyrie_init_display(struct display *disp);static void valkyrie_par_to_fix(struct fb_par_valkyrie *par, struct fb_fix_screeninfo *fix,	struct fb_info_valkyrie *p);static void valkyrie_init_fix(struct fb_fix_screeninfo *fix, struct fb_info_valkyrie *p);static struct fb_ops valkyriefb_ops = {	owner:		THIS_MODULE,	fb_get_fix:	valkyrie_get_fix,	fb_get_var:	valkyrie_get_var,	fb_set_var:	valkyrie_set_var,	fb_get_cmap:	valkyrie_get_cmap,	fb_set_cmap:	valkyrie_set_cmap,};static int valkyriefb_getcolreg(u_int regno, u_int *red, u_int *green,			     u_int *blue, u_int *transp, struct fb_info *info);static int valkyriefb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,			     u_int transp, struct fb_info *info);static void do_install_cmap(int con, struct fb_info *info);static int valkyrie_get_fix(struct fb_fix_screeninfo *fix, int con,			 struct fb_info *info){	struct fb_info_valkyrie *cp = (struct fb_info_valkyrie *) info;	*fix = cp->fix;	return 0;}static int valkyrie_get_var(struct fb_var_screeninfo *var, int con,			 struct fb_info *info){	struct fb_info_valkyrie *cp = (struct fb_info_valkyrie *) info;	*var = cp->var;	return 0;}/* Sets everything according to var */static int valkyrie_set_var(struct fb_var_screeninfo *var, int con,			 struct fb_info *info){	struct fb_info_valkyrie *p = (struct fb_info_valkyrie *) info;	struct display *disp;	struct fb_par_valkyrie par;	int depthchange, err;	disp = (con >= 0) ? &fb_display[con] : &p->disp;	if ((err = valkyrie_var_to_par(var, &par, info))) {		 /* printk (KERN_ERR "Error in valkyrie_set_var, calling valkyrie_var_to_par: %d.\n", err); */		return err;	}		if ((var->activate & FB_ACTIVATE_MASK) != FB_ACTIVATE_NOW) {		/* printk(KERN_ERR "Not activating, in valkyrie_set_var.\n"); */		valkyrie_par_to_var(&par, var);		return 0;	}	/*	 * I know, we want to use fb_display[con], but grab certain info	 * from p->var instead.	 */#define DIRTY(x) (p->var.x != var->x)	depthchange = DIRTY(bits_per_pixel);	/* adding "&& !DIRTY(pixclock)" corrects vmode-switching problems */	if(!DIRTY(xres) && !DIRTY(yres) && !DIRTY(xres_virtual) &&	   !DIRTY(yres_virtual) && !DIRTY(bits_per_pixel) && !DIRTY(pixclock)) {	   	valkyrie_par_to_var(&par, var);		p->var = disp->var = *var;		return 0;	}	p->par = par;	valkyrie_par_to_var(&par, var);	p->var = *var;	valkyrie_par_to_fix(&par, &p->fix, p);	valkyrie_par_to_display(&par, disp, &p->fix, p);	p->disp = *disp;		if (info->changevar && !switching) {		/* Don't want to do this if just switching consoles. */		(*info->changevar)(con);	}	if (con == currcon)		valkyrie_set_par(&par, p);	if (depthchange)		if ((err = fb_alloc_cmap(&disp->cmap, 0, 0)))			return err;	if (depthchange || switching)		do_install_cmap(con, info);	return 0;}static int valkyrie_get_cmap(struct fb_cmap *cmap, int kspc, int con,			  struct fb_info *info){	if (con == currcon)	{		/* current console? */		return fb_get_cmap(cmap, kspc, valkyriefb_getcolreg, info);	}	if (fb_display[con].cmap.len) { /* non default colormap? */		fb_copy_cmap(&fb_display[con].cmap, cmap, kspc? 0: 2);	}	else {		int size = fb_display[con].var.bits_per_pixel == 16 ? 32 : 256;		fb_copy_cmap(fb_default_cmap(size), cmap, kspc ? 0 : 2);	}	return 0;}static int valkyrie_set_cmap(struct fb_cmap *cmap, int kspc, int con,			 struct fb_info *info){	struct display *disp = &fb_display[con];	int err;	if (disp->cmap.len == 0) {		int size = fb_display[con].var.bits_per_pixel == 16 ? 32 : 256;		err = fb_alloc_cmap(&disp->cmap, size, 0);		if (err) {			return err;		}	}	if (con == currcon) {		return fb_set_cmap(cmap, kspc, valkyriefb_setcolreg, info);	}	fb_copy_cmap(cmap, &disp->cmap, kspc ? 0 : 1);	return 0;}static int valkyriefb_switch(int con, struct fb_info *fb){	struct fb_info_valkyrie *info = (struct fb_info_valkyrie *) fb;	struct fb_par_valkyrie par;	if (fb_display[currcon].cmap.len)		fb_get_cmap(&fb_display[currcon].cmap, 1, valkyriefb_getcolreg,			    fb);	currcon = con;#if 1	valkyrie_var_to_par(&fb_display[currcon].var, &par, fb);	valkyrie_set_par(&par, info);	do_install_cmap(con, fb);#else	/* I see no reason not to do this.  Minus info->changevar(). */	/* DOH.  This makes valkyrie_set_var compare, you guessed it, */	/* fb_display[con].var (first param), and fb_display[con].var! */	/* Perhaps I just fixed that... */	switching = 1;	valkyrie_set_var(&fb_display[con].var, con, info);	switching = 0;#endif	return 0;}static int valkyriefb_updatevar(int con, struct fb_info *info){	return 0;}static void valkyriefb_blank(int blank_mode, struct fb_info *info){/* *  Blank the screen if blank_mode != 0, else unblank. If blank_mode == NULL *  then the caller blanks by setting the CLUT (Color Look Up Table) to all *  black. Return 0 if blanking succeeded, != 0 if un-/blanking failed due *  to e.g. a video mode which doesn't support it. Implements VESA suspend *  and powerdown modes on hardware that supports disabling hsync/vsync: *    blank_mode == 2: suspend vsync *    blank_mode == 3: suspend hsync *    blank_mode == 4: powerdown */	struct fb_info_valkyrie *p = (struct fb_info_valkyrie *) info;	struct valkyrie_regvals	*init;	unsigned char vmode;	if (p->disp.can_soft_blank	 && ((vmode = p->par.vmode) > 0)	 && (vmode <= VMODE_MAX)	 && ((init = valkyrie_reg_init[vmode - 1]) != NULL)) {		if (blank_mode)			--blank_mode;		switch (blank_mode) {		default:	/* unblank */			out_8(&p->valkyrie_regs->mode.r, init->mode);			break;		case VESA_VSYNC_SUSPEND:		case VESA_HSYNC_SUSPEND:			/*			 * [kps] Value extracted from MacOS. I don't know			 * whether this bit disables hsync or vsync, or			 * whether the hardware can do the other as well.			 */			out_8(&p->valkyrie_regs->mode.r, init->mode | 0x40);			break;		case VESA_POWERDOWN:			out_8(&p->valkyrie_regs->mode.r, 0x66);			break;		}	}}static int valkyriefb_getcolreg(u_int regno, u_int *red, u_int *green,			     u_int *blue, u_int *transp, struct fb_info *info){	struct fb_info_valkyrie *p = (struct fb_info_valkyrie *) info;	if (regno > 255)		return 1;	*red = (p->palette[regno].red<<8) | p->palette[regno].red;	*green = (p->palette[regno].green<<8) | p->palette[regno].green;	*blue = (p->palette[regno].blue<<8) | p->palette[regno].blue;	return 0;}static int valkyriefb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,			     u_int transp, struct fb_info *info){	struct fb_info_valkyrie *p = (struct fb_info_valkyrie *) info;	volatile struct cmap_regs *cmap_regs = p->cmap_regs;	if (regno > 255)		return 1;	red >>= 8;	green >>= 8;	blue >>= 8;	p->palette[regno].red = red;	p->palette[regno].green = green;	p->palette[regno].blue = blue;	/* tell clut which address to fill */	out_8(&p->cmap_regs->addr, regno);	udelay(1);	/* send one color channel at a time */	out_8(&cmap_regs->lut, red);	out_8(&cmap_regs->lut, green);	out_8(&cmap_regs->lut, blue);	if (regno < 16) {#ifdef FBCON_HAS_CFB16		p->fbcon_cfb16_cmap[regno] = (regno << 10) | (regno << 5) | regno;#endif	}	return 0;}static void do_install_cmap(int con, struct fb_info *info){	if (con != currcon)		return;	if (fb_display[con].cmap.len) {		fb_set_cmap(&fb_display[con].cmap, 1, valkyriefb_setcolreg,			    info);	}	else {		int size = fb_display[con].var.bits_per_pixel == 16 ? 32 : 256;		fb_set_cmap(fb_default_cmap(size), 1, valkyriefb_setcolreg,			    info);	}}#ifdef CONFIG_FB_COMPAT_XPMACextern struct vc_mode display_info;extern struct fb_info *console_fb_info;#endif /* CONFIG_FB_COMPAT_XPMAC */static int valkyrie_vram_reqd(int video_mode, int color_mode){	int pitch;		if ((pitch = valkyrie_reg_init[video_mode-1]->pitch[color_mode]) == 0)		pitch = 2 * valkyrie_reg_init[video_mode-1]->pitch[0];	return valkyrie_reg_init[video_mode-1]->vres * pitch;}