diff options
Diffstat (limited to 'drivers/video/fbdev/ffb.c')
| -rw-r--r-- | drivers/video/fbdev/ffb.c | 1081 | 
1 files changed, 1081 insertions, 0 deletions
diff --git a/drivers/video/fbdev/ffb.c b/drivers/video/fbdev/ffb.c new file mode 100644 index 00000000000..4c4ffa61ae2 --- /dev/null +++ b/drivers/video/fbdev/ffb.c @@ -0,0 +1,1081 @@ +/* ffb.c: Creator/Elite3D frame buffer driver + * + * Copyright (C) 2003, 2006 David S. Miller (davem@davemloft.net) + * Copyright (C) 1997,1998,1999 Jakub Jelinek (jj@ultra.linux.cz) + * + * Driver layout based loosely on tgafb.c, see that file for credits. + */ + +#include <linux/module.h> +#include <linux/kernel.h> +#include <linux/errno.h> +#include <linux/string.h> +#include <linux/delay.h> +#include <linux/init.h> +#include <linux/fb.h> +#include <linux/mm.h> +#include <linux/timer.h> +#include <linux/of_device.h> + +#include <asm/io.h> +#include <asm/upa.h> +#include <asm/fbio.h> + +#include "sbuslib.h" + +/* + * Local functions. + */ + +static int ffb_setcolreg(unsigned, unsigned, unsigned, unsigned, +			 unsigned, struct fb_info *); +static int ffb_blank(int, struct fb_info *); + +static void ffb_imageblit(struct fb_info *, const struct fb_image *); +static void ffb_fillrect(struct fb_info *, const struct fb_fillrect *); +static void ffb_copyarea(struct fb_info *, const struct fb_copyarea *); +static int ffb_sync(struct fb_info *); +static int ffb_mmap(struct fb_info *, struct vm_area_struct *); +static int ffb_ioctl(struct fb_info *, unsigned int, unsigned long); +static int ffb_pan_display(struct fb_var_screeninfo *, struct fb_info *); + +/* + *  Frame buffer operations + */ + +static struct fb_ops ffb_ops = { +	.owner			= THIS_MODULE, +	.fb_setcolreg		= ffb_setcolreg, +	.fb_blank		= ffb_blank, +	.fb_pan_display		= ffb_pan_display, +	.fb_fillrect		= ffb_fillrect, +	.fb_copyarea		= ffb_copyarea, +	.fb_imageblit		= ffb_imageblit, +	.fb_sync		= ffb_sync, +	.fb_mmap		= ffb_mmap, +	.fb_ioctl		= ffb_ioctl, +#ifdef CONFIG_COMPAT +	.fb_compat_ioctl	= sbusfb_compat_ioctl, +#endif +}; + +/* Register layout and definitions */ +#define	FFB_SFB8R_VOFF		0x00000000 +#define	FFB_SFB8G_VOFF		0x00400000 +#define	FFB_SFB8B_VOFF		0x00800000 +#define	FFB_SFB8X_VOFF		0x00c00000 +#define	FFB_SFB32_VOFF		0x01000000 +#define	FFB_SFB64_VOFF		0x02000000 +#define	FFB_FBC_REGS_VOFF	0x04000000 +#define	FFB_BM_FBC_REGS_VOFF	0x04002000 +#define	FFB_DFB8R_VOFF		0x04004000 +#define	FFB_DFB8G_VOFF		0x04404000 +#define	FFB_DFB8B_VOFF		0x04804000 +#define	FFB_DFB8X_VOFF		0x04c04000 +#define	FFB_DFB24_VOFF		0x05004000 +#define	FFB_DFB32_VOFF		0x06004000 +#define	FFB_DFB422A_VOFF	0x07004000	/* DFB 422 mode write to A */ +#define	FFB_DFB422AD_VOFF	0x07804000	/* DFB 422 mode with line doubling */ +#define	FFB_DFB24B_VOFF		0x08004000	/* DFB 24bit mode write to B */ +#define	FFB_DFB422B_VOFF	0x09004000	/* DFB 422 mode write to B */ +#define	FFB_DFB422BD_VOFF	0x09804000	/* DFB 422 mode with line doubling */ +#define	FFB_SFB16Z_VOFF		0x0a004000	/* 16bit mode Z planes */ +#define	FFB_SFB8Z_VOFF		0x0a404000	/* 8bit mode Z planes */ +#define	FFB_SFB422_VOFF		0x0ac04000	/* SFB 422 mode write to A/B */ +#define	FFB_SFB422D_VOFF	0x0b404000	/* SFB 422 mode with line doubling */ +#define	FFB_FBC_KREGS_VOFF	0x0bc04000 +#define	FFB_DAC_VOFF		0x0bc06000 +#define	FFB_PROM_VOFF		0x0bc08000 +#define	FFB_EXP_VOFF		0x0bc18000 + +#define	FFB_SFB8R_POFF		0x04000000UL +#define	FFB_SFB8G_POFF		0x04400000UL +#define	FFB_SFB8B_POFF		0x04800000UL +#define	FFB_SFB8X_POFF		0x04c00000UL +#define	FFB_SFB32_POFF		0x05000000UL +#define	FFB_SFB64_POFF		0x06000000UL +#define	FFB_FBC_REGS_POFF	0x00600000UL +#define	FFB_BM_FBC_REGS_POFF	0x00600000UL +#define	FFB_DFB8R_POFF		0x01000000UL +#define	FFB_DFB8G_POFF		0x01400000UL +#define	FFB_DFB8B_POFF		0x01800000UL +#define	FFB_DFB8X_POFF		0x01c00000UL +#define	FFB_DFB24_POFF		0x02000000UL +#define	FFB_DFB32_POFF		0x03000000UL +#define	FFB_FBC_KREGS_POFF	0x00610000UL +#define	FFB_DAC_POFF		0x00400000UL +#define	FFB_PROM_POFF		0x00000000UL +#define	FFB_EXP_POFF		0x00200000UL +#define FFB_DFB422A_POFF	0x09000000UL +#define FFB_DFB422AD_POFF	0x09800000UL +#define FFB_DFB24B_POFF		0x0a000000UL +#define FFB_DFB422B_POFF	0x0b000000UL +#define FFB_DFB422BD_POFF	0x0b800000UL +#define FFB_SFB16Z_POFF		0x0c800000UL +#define FFB_SFB8Z_POFF		0x0c000000UL +#define FFB_SFB422_POFF		0x0d000000UL +#define FFB_SFB422D_POFF	0x0d800000UL + +/* Draw operations */ +#define FFB_DRAWOP_DOT		0x00 +#define FFB_DRAWOP_AADOT	0x01 +#define FFB_DRAWOP_BRLINECAP	0x02 +#define FFB_DRAWOP_BRLINEOPEN	0x03 +#define FFB_DRAWOP_DDLINE	0x04 +#define FFB_DRAWOP_AALINE	0x05 +#define FFB_DRAWOP_TRIANGLE	0x06 +#define FFB_DRAWOP_POLYGON	0x07 +#define FFB_DRAWOP_RECTANGLE	0x08 +#define FFB_DRAWOP_FASTFILL	0x09 +#define FFB_DRAWOP_BCOPY	0x0a +#define FFB_DRAWOP_VSCROLL	0x0b + +/* Pixel processor control */ +/* Force WID */ +#define FFB_PPC_FW_DISABLE	0x800000 +#define FFB_PPC_FW_ENABLE	0xc00000 +/* Auxiliary clip */ +#define FFB_PPC_ACE_DISABLE	0x040000 +#define FFB_PPC_ACE_AUX_SUB	0x080000 +#define FFB_PPC_ACE_AUX_ADD	0x0c0000 +/* Depth cue */ +#define FFB_PPC_DCE_DISABLE	0x020000 +#define FFB_PPC_DCE_ENABLE	0x030000 +/* Alpha blend */ +#define FFB_PPC_ABE_DISABLE	0x008000 +#define FFB_PPC_ABE_ENABLE	0x00c000 +/* View clip */ +#define FFB_PPC_VCE_DISABLE	0x001000 +#define FFB_PPC_VCE_2D		0x002000 +#define FFB_PPC_VCE_3D		0x003000 +/* Area pattern */ +#define FFB_PPC_APE_DISABLE	0x000800 +#define FFB_PPC_APE_ENABLE	0x000c00 +/* Transparent background */ +#define FFB_PPC_TBE_OPAQUE	0x000200 +#define FFB_PPC_TBE_TRANSPARENT	0x000300 +/* Z source */ +#define FFB_PPC_ZS_VAR		0x000080 +#define FFB_PPC_ZS_CONST	0x0000c0 +/* Y source */ +#define FFB_PPC_YS_VAR		0x000020 +#define FFB_PPC_YS_CONST	0x000030 +/* X source */ +#define FFB_PPC_XS_WID		0x000004 +#define FFB_PPC_XS_VAR		0x000008 +#define FFB_PPC_XS_CONST	0x00000c +/* Color (BGR) source */ +#define FFB_PPC_CS_VAR		0x000002 +#define FFB_PPC_CS_CONST	0x000003 + +#define FFB_ROP_NEW		0x83 +#define FFB_ROP_OLD		0x85 +#define FFB_ROP_NEW_XOR_OLD	0x86 + +#define FFB_UCSR_FIFO_MASK	0x00000fff +#define FFB_UCSR_FB_BUSY	0x01000000 +#define FFB_UCSR_RP_BUSY	0x02000000 +#define FFB_UCSR_ALL_BUSY	(FFB_UCSR_RP_BUSY|FFB_UCSR_FB_BUSY) +#define FFB_UCSR_READ_ERR	0x40000000 +#define FFB_UCSR_FIFO_OVFL	0x80000000 +#define FFB_UCSR_ALL_ERRORS	(FFB_UCSR_READ_ERR|FFB_UCSR_FIFO_OVFL) + +struct ffb_fbc { +	/* Next vertex registers */ +	u32	xxx1[3]; +	u32	alpha; +	u32	red; +	u32	green; +	u32	blue; +	u32	depth; +	u32	y; +	u32	x; +	u32	xxx2[2]; +	u32	ryf; +	u32	rxf; +	u32	xxx3[2]; + +	u32	dmyf; +	u32	dmxf; +	u32	xxx4[2]; +	u32	ebyi; +	u32	ebxi; +	u32	xxx5[2]; +	u32	by; +	u32	bx; +	u32	dy; +	u32	dx; +	u32	bh; +	u32	bw; +	u32	xxx6[2]; + +	u32	xxx7[32]; + +	/* Setup unit vertex state register */ +	u32	suvtx; +	u32	xxx8[63]; + +	/* Control registers */ +	u32	ppc; +	u32	wid; +	u32	fg; +	u32	bg; +	u32	consty; +	u32	constz; +	u32	xclip; +	u32	dcss; +	u32	vclipmin; +	u32	vclipmax; +	u32	vclipzmin; +	u32	vclipzmax; +	u32	dcsf; +	u32	dcsb; +	u32	dczf; +	u32	dczb; + +	u32	xxx9; +	u32	blendc; +	u32	blendc1; +	u32	blendc2; +	u32	fbramitc; +	u32	fbc; +	u32	rop; +	u32	cmp; +	u32	matchab; +	u32	matchc; +	u32	magnab; +	u32	magnc; +	u32	fbcfg0; +	u32	fbcfg1; +	u32	fbcfg2; +	u32	fbcfg3; + +	u32	ppcfg; +	u32	pick; +	u32	fillmode; +	u32	fbramwac; +	u32	pmask; +	u32	xpmask; +	u32	ypmask; +	u32	zpmask; +	u32	clip0min; +	u32	clip0max; +	u32	clip1min; +	u32	clip1max; +	u32	clip2min; +	u32	clip2max; +	u32	clip3min; +	u32	clip3max; + +	/* New 3dRAM III support regs */ +	u32	rawblend2; +	u32	rawpreblend; +	u32	rawstencil; +	u32	rawstencilctl; +	u32	threedram1; +	u32	threedram2; +	u32	passin; +	u32	rawclrdepth; +	u32	rawpmask; +	u32	rawcsrc; +	u32	rawmatch; +	u32	rawmagn; +	u32	rawropblend; +	u32	rawcmp; +	u32	rawwac; +	u32	fbramid; + +	u32	drawop; +	u32	xxx10[2]; +	u32	fontlpat; +	u32	xxx11; +	u32	fontxy; +	u32	fontw; +	u32	fontinc; +	u32	font; +	u32	xxx12[3]; +	u32	blend2; +	u32	preblend; +	u32	stencil; +	u32	stencilctl; + +	u32	xxx13[4]; +	u32	dcss1; +	u32	dcss2; +	u32	dcss3; +	u32	widpmask; +	u32	dcs2; +	u32	dcs3; +	u32	dcs4; +	u32	xxx14; +	u32	dcd2; +	u32	dcd3; +	u32	dcd4; +	u32	xxx15; + +	u32	pattern[32]; + +	u32	xxx16[256]; + +	u32	devid; +	u32	xxx17[63]; + +	u32	ucsr; +	u32	xxx18[31]; + +	u32	mer; +}; + +struct ffb_dac { +	u32	type; +	u32	value; +	u32	type2; +	u32	value2; +}; + +#define FFB_DAC_UCTRL		0x1001 /* User Control */ +#define FFB_DAC_UCTRL_MANREV	0x00000f00 /* 4-bit Manufacturing Revision */ +#define FFB_DAC_UCTRL_MANREV_SHIFT 8 +#define FFB_DAC_TGEN		0x6000 /* Timing Generator */ +#define FFB_DAC_TGEN_VIDE	0x00000001 /* Video Enable */ +#define FFB_DAC_DID		0x8000 /* Device Identification */ +#define FFB_DAC_DID_PNUM	0x0ffff000 /* Device Part Number */ +#define FFB_DAC_DID_PNUM_SHIFT	12 +#define FFB_DAC_DID_REV		0xf0000000 /* Device Revision */ +#define FFB_DAC_DID_REV_SHIFT	28 + +#define FFB_DAC_CUR_CTRL	0x100 +#define FFB_DAC_CUR_CTRL_P0	0x00000001 +#define FFB_DAC_CUR_CTRL_P1	0x00000002 + +struct ffb_par { +	spinlock_t		lock; +	struct ffb_fbc __iomem	*fbc; +	struct ffb_dac __iomem	*dac; + +	u32			flags; +#define FFB_FLAG_AFB		0x00000001 /* AFB m3 or m6 */ +#define FFB_FLAG_BLANKED	0x00000002 /* screen is blanked */ +#define FFB_FLAG_INVCURSOR	0x00000004 /* DAC has inverted cursor logic */ + +	u32			fg_cache __attribute__((aligned (8))); +	u32			bg_cache; +	u32			rop_cache; + +	int			fifo_cache; + +	unsigned long		physbase; +	unsigned long		fbsize; + +	int			board_type; + +	u32			pseudo_palette[16]; +}; + +static void FFBFifo(struct ffb_par *par, int n) +{ +	struct ffb_fbc __iomem *fbc; +	int cache = par->fifo_cache; + +	if (cache - n < 0) { +		fbc = par->fbc; +		do { +			cache = (upa_readl(&fbc->ucsr) & FFB_UCSR_FIFO_MASK); +			cache -= 8; +		} while (cache - n < 0); +	} +	par->fifo_cache = cache - n; +} + +static void FFBWait(struct ffb_par *par) +{ +	struct ffb_fbc __iomem *fbc; +	int limit = 10000; + +	fbc = par->fbc; +	do { +		if ((upa_readl(&fbc->ucsr) & FFB_UCSR_ALL_BUSY) == 0) +			break; +		if ((upa_readl(&fbc->ucsr) & FFB_UCSR_ALL_ERRORS) != 0) { +			upa_writel(FFB_UCSR_ALL_ERRORS, &fbc->ucsr); +		} +		udelay(10); +	} while (--limit > 0); +} + +static int ffb_sync(struct fb_info *p) +{ +	struct ffb_par *par = (struct ffb_par *)p->par; + +	FFBWait(par); +	return 0; +} + +static __inline__ void ffb_rop(struct ffb_par *par, u32 rop) +{ +	if (par->rop_cache != rop) { +		FFBFifo(par, 1); +		upa_writel(rop, &par->fbc->rop); +		par->rop_cache = rop; +	} +} + +static void ffb_switch_from_graph(struct ffb_par *par) +{ +	struct ffb_fbc __iomem *fbc = par->fbc; +	struct ffb_dac __iomem *dac = par->dac; +	unsigned long flags; + +	spin_lock_irqsave(&par->lock, flags); +	FFBWait(par); +	par->fifo_cache = 0; +	FFBFifo(par, 7); +	upa_writel(FFB_PPC_VCE_DISABLE | FFB_PPC_TBE_OPAQUE | +		   FFB_PPC_APE_DISABLE | FFB_PPC_CS_CONST, +		   &fbc->ppc); +	upa_writel(0x2000707f, &fbc->fbc); +	upa_writel(par->rop_cache, &fbc->rop); +	upa_writel(0xffffffff, &fbc->pmask); +	upa_writel((1 << 16) | (0 << 0), &fbc->fontinc); +	upa_writel(par->fg_cache, &fbc->fg); +	upa_writel(par->bg_cache, &fbc->bg); +	FFBWait(par); + +	/* Disable cursor.  */ +	upa_writel(FFB_DAC_CUR_CTRL, &dac->type2); +	if (par->flags & FFB_FLAG_INVCURSOR) +		upa_writel(0, &dac->value2); +	else +		upa_writel((FFB_DAC_CUR_CTRL_P0 | +			    FFB_DAC_CUR_CTRL_P1), &dac->value2); + +	spin_unlock_irqrestore(&par->lock, flags); +} + +static int ffb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; + +	/* We just use this to catch switches out of +	 * graphics mode. +	 */ +	ffb_switch_from_graph(par); + +	if (var->xoffset || var->yoffset || var->vmode) +		return -EINVAL; +	return 0; +} + +/** + *	ffb_fillrect - Draws a rectangle on the screen. + * + *	@info: frame buffer structure that represents a single frame buffer + *	@rect: structure defining the rectagle and operation. + */ +static void ffb_fillrect(struct fb_info *info, const struct fb_fillrect *rect) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; +	struct ffb_fbc __iomem *fbc = par->fbc; +	unsigned long flags; +	u32 fg; + +	BUG_ON(rect->rop != ROP_COPY && rect->rop != ROP_XOR); + +	fg = ((u32 *)info->pseudo_palette)[rect->color]; + +	spin_lock_irqsave(&par->lock, flags); + +	if (fg != par->fg_cache) { +		FFBFifo(par, 1); +		upa_writel(fg, &fbc->fg); +		par->fg_cache = fg; +	} + +	ffb_rop(par, rect->rop == ROP_COPY ? +		     FFB_ROP_NEW : +		     FFB_ROP_NEW_XOR_OLD); + +	FFBFifo(par, 5); +	upa_writel(FFB_DRAWOP_RECTANGLE, &fbc->drawop); +	upa_writel(rect->dy, &fbc->by); +	upa_writel(rect->dx, &fbc->bx); +	upa_writel(rect->height, &fbc->bh); +	upa_writel(rect->width, &fbc->bw); + +	spin_unlock_irqrestore(&par->lock, flags); +} + +/** + *	ffb_copyarea - Copies on area of the screen to another area. + * + *	@info: frame buffer structure that represents a single frame buffer + *	@area: structure defining the source and destination. + */ + +static void ffb_copyarea(struct fb_info *info, const struct fb_copyarea *area) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; +	struct ffb_fbc __iomem *fbc = par->fbc; +	unsigned long flags; + +	if (area->dx != area->sx || +	    area->dy == area->sy) { +		cfb_copyarea(info, area); +		return; +	} + +	spin_lock_irqsave(&par->lock, flags); + +	ffb_rop(par, FFB_ROP_OLD); + +	FFBFifo(par, 7); +	upa_writel(FFB_DRAWOP_VSCROLL, &fbc->drawop); +	upa_writel(area->sy, &fbc->by); +	upa_writel(area->sx, &fbc->bx); +	upa_writel(area->dy, &fbc->dy); +	upa_writel(area->dx, &fbc->dx); +	upa_writel(area->height, &fbc->bh); +	upa_writel(area->width, &fbc->bw); + +	spin_unlock_irqrestore(&par->lock, flags); +} + +/** + *	ffb_imageblit - Copies a image from system memory to the screen. + * + *	@info: frame buffer structure that represents a single frame buffer + *	@image: structure defining the image. + */ +static void ffb_imageblit(struct fb_info *info, const struct fb_image *image) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; +	struct ffb_fbc __iomem *fbc = par->fbc; +	const u8 *data = image->data; +	unsigned long flags; +	u32 fg, bg, xy; +	u64 fgbg; +	int i, width, stride; + +	if (image->depth > 1) { +		cfb_imageblit(info, image); +		return; +	} + +	fg = ((u32 *)info->pseudo_palette)[image->fg_color]; +	bg = ((u32 *)info->pseudo_palette)[image->bg_color]; +	fgbg = ((u64) fg << 32) | (u64) bg; +	xy = (image->dy << 16) | image->dx; +	width = image->width; +	stride = ((width + 7) >> 3); + +	spin_lock_irqsave(&par->lock, flags); + +	if (fgbg != *(u64 *)&par->fg_cache) { +		FFBFifo(par, 2); +		upa_writeq(fgbg, &fbc->fg); +		*(u64 *)&par->fg_cache = fgbg; +	} + +	if (width >= 32) { +		FFBFifo(par, 1); +		upa_writel(32, &fbc->fontw); +	} + +	while (width >= 32) { +		const u8 *next_data = data + 4; + +		FFBFifo(par, 1); +		upa_writel(xy, &fbc->fontxy); +		xy += (32 << 0); + +		for (i = 0; i < image->height; i++) { +			u32 val = (((u32)data[0] << 24) | +				   ((u32)data[1] << 16) | +				   ((u32)data[2] <<  8) | +				   ((u32)data[3] <<  0)); +			FFBFifo(par, 1); +			upa_writel(val, &fbc->font); + +			data += stride; +		} + +		data = next_data; +		width -= 32; +	} + +	if (width) { +		FFBFifo(par, 2); +		upa_writel(width, &fbc->fontw); +		upa_writel(xy, &fbc->fontxy); + +		for (i = 0; i < image->height; i++) { +			u32 val = (((u32)data[0] << 24) | +				   ((u32)data[1] << 16) | +				   ((u32)data[2] <<  8) | +				   ((u32)data[3] <<  0)); +			FFBFifo(par, 1); +			upa_writel(val, &fbc->font); + +			data += stride; +		} +	} + +	spin_unlock_irqrestore(&par->lock, flags); +} + +static void ffb_fixup_var_rgb(struct fb_var_screeninfo *var) +{ +	var->red.offset = 0; +	var->red.length = 8; +	var->green.offset = 8; +	var->green.length = 8; +	var->blue.offset = 16; +	var->blue.length = 8; +	var->transp.offset = 0; +	var->transp.length = 0; +} + +/** + *	ffb_setcolreg - Sets a color register. + * + *	@regno: boolean, 0 copy local, 1 get_user() function + *	@red: frame buffer colormap structure + *	@green: The green value which can be up to 16 bits wide + *	@blue:  The blue value which can be up to 16 bits wide. + *	@transp: If supported the alpha value which can be up to 16 bits wide. + *	@info: frame buffer info structure + */ +static int ffb_setcolreg(unsigned regno, +			 unsigned red, unsigned green, unsigned blue, +			 unsigned transp, struct fb_info *info) +{ +	u32 value; + +	if (regno >= 16) +		return 1; + +	red >>= 8; +	green >>= 8; +	blue >>= 8; + +	value = (blue << 16) | (green << 8) | red; +	((u32 *)info->pseudo_palette)[regno] = value; + +	return 0; +} + +/** + *	ffb_blank - Optional function.  Blanks the display. + *	@blank_mode: the blank mode we want. + *	@info: frame buffer structure that represents a single frame buffer + */ +static int ffb_blank(int blank, struct fb_info *info) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; +	struct ffb_dac __iomem *dac = par->dac; +	unsigned long flags; +	u32 val; +	int i; + +	spin_lock_irqsave(&par->lock, flags); + +	FFBWait(par); + +	upa_writel(FFB_DAC_TGEN, &dac->type); +	val = upa_readl(&dac->value); +	switch (blank) { +	case FB_BLANK_UNBLANK: /* Unblanking */ +		val |= FFB_DAC_TGEN_VIDE; +		par->flags &= ~FFB_FLAG_BLANKED; +		break; + +	case FB_BLANK_NORMAL: /* Normal blanking */ +	case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */ +	case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */ +	case FB_BLANK_POWERDOWN: /* Poweroff */ +		val &= ~FFB_DAC_TGEN_VIDE; +		par->flags |= FFB_FLAG_BLANKED; +		break; +	} +	upa_writel(FFB_DAC_TGEN, &dac->type); +	upa_writel(val, &dac->value); +	for (i = 0; i < 10; i++) { +		upa_writel(FFB_DAC_TGEN, &dac->type); +		upa_readl(&dac->value); +	} + +	spin_unlock_irqrestore(&par->lock, flags); + +	return 0; +} + +static struct sbus_mmap_map ffb_mmap_map[] = { +	{ +		.voff	= FFB_SFB8R_VOFF, +		.poff	= FFB_SFB8R_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_SFB8G_VOFF, +		.poff	= FFB_SFB8G_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_SFB8B_VOFF, +		.poff	= FFB_SFB8B_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_SFB8X_VOFF, +		.poff	= FFB_SFB8X_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_SFB32_VOFF, +		.poff	= FFB_SFB32_POFF, +		.size	= 0x1000000 +	}, +	{ +		.voff	= FFB_SFB64_VOFF, +		.poff	= FFB_SFB64_POFF, +		.size	= 0x2000000 +	}, +	{ +		.voff	= FFB_FBC_REGS_VOFF, +		.poff	= FFB_FBC_REGS_POFF, +		.size	= 0x0002000 +	}, +	{ +		.voff	= FFB_BM_FBC_REGS_VOFF, +		.poff	= FFB_BM_FBC_REGS_POFF, +		.size	= 0x0002000 +	}, +	{ +		.voff	= FFB_DFB8R_VOFF, +		.poff	= FFB_DFB8R_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_DFB8G_VOFF, +		.poff	= FFB_DFB8G_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_DFB8B_VOFF, +		.poff	= FFB_DFB8B_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_DFB8X_VOFF, +		.poff	= FFB_DFB8X_POFF, +		.size	= 0x0400000 +	}, +	{ +		.voff	= FFB_DFB24_VOFF, +		.poff	= FFB_DFB24_POFF, +		.size	= 0x1000000 +	}, +	{ +		.voff	= FFB_DFB32_VOFF, +		.poff	= FFB_DFB32_POFF, +		.size	= 0x1000000 +	}, +	{ +		.voff	= FFB_FBC_KREGS_VOFF, +		.poff	= FFB_FBC_KREGS_POFF, +		.size	= 0x0002000 +	}, +	{ +		.voff	= FFB_DAC_VOFF, +		.poff	= FFB_DAC_POFF, +		.size	= 0x0002000 +	}, +	{ +		.voff	= FFB_PROM_VOFF, +		.poff	= FFB_PROM_POFF, +		.size	= 0x0010000 +	}, +	{ +		.voff	= FFB_EXP_VOFF, +		.poff	= FFB_EXP_POFF, +		.size	= 0x0002000 +	}, +	{ +		.voff	= FFB_DFB422A_VOFF, +		.poff	= FFB_DFB422A_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_DFB422AD_VOFF, +		.poff	= FFB_DFB422AD_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_DFB24B_VOFF, +		.poff	= FFB_DFB24B_POFF, +		.size	= 0x1000000 +	}, +	{ +		.voff	= FFB_DFB422B_VOFF, +		.poff	= FFB_DFB422B_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_DFB422BD_VOFF, +		.poff	= FFB_DFB422BD_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_SFB16Z_VOFF, +		.poff	= FFB_SFB16Z_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_SFB8Z_VOFF, +		.poff	= FFB_SFB8Z_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_SFB422_VOFF, +		.poff	= FFB_SFB422_POFF, +		.size	= 0x0800000 +	}, +	{ +		.voff	= FFB_SFB422D_VOFF, +		.poff	= FFB_SFB422D_POFF, +		.size	= 0x0800000 +	}, +	{ .size = 0 } +}; + +static int ffb_mmap(struct fb_info *info, struct vm_area_struct *vma) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; + +	return sbusfb_mmap_helper(ffb_mmap_map, +				  par->physbase, par->fbsize, +				  0, vma); +} + +static int ffb_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; + +	return sbusfb_ioctl_helper(cmd, arg, info, +				   FBTYPE_CREATOR, 24, par->fbsize); +} + +/* + *  Initialisation + */ + +static void ffb_init_fix(struct fb_info *info) +{ +	struct ffb_par *par = (struct ffb_par *)info->par; +	const char *ffb_type_name; + +	if (!(par->flags & FFB_FLAG_AFB)) { +		if ((par->board_type & 0x7) == 0x3) +			ffb_type_name = "Creator 3D"; +		else +			ffb_type_name = "Creator"; +	} else +		ffb_type_name = "Elite 3D"; + +	strlcpy(info->fix.id, ffb_type_name, sizeof(info->fix.id)); + +	info->fix.type = FB_TYPE_PACKED_PIXELS; +	info->fix.visual = FB_VISUAL_TRUECOLOR; + +	/* Framebuffer length is the same regardless of resolution. */ +	info->fix.line_length = 8192; + +	info->fix.accel = FB_ACCEL_SUN_CREATOR; +} + +static int ffb_probe(struct platform_device *op) +{ +	struct device_node *dp = op->dev.of_node; +	struct ffb_fbc __iomem *fbc; +	struct ffb_dac __iomem *dac; +	struct fb_info *info; +	struct ffb_par *par; +	u32 dac_pnum, dac_rev, dac_mrev; +	int err; + +	info = framebuffer_alloc(sizeof(struct ffb_par), &op->dev); + +	err = -ENOMEM; +	if (!info) +		goto out_err; + +	par = info->par; + +	spin_lock_init(&par->lock); +	par->fbc = of_ioremap(&op->resource[2], 0, +			      sizeof(struct ffb_fbc), "ffb fbc"); +	if (!par->fbc) +		goto out_release_fb; + +	par->dac = of_ioremap(&op->resource[1], 0, +			      sizeof(struct ffb_dac), "ffb dac"); +	if (!par->dac) +		goto out_unmap_fbc; + +	par->rop_cache = FFB_ROP_NEW; +	par->physbase = op->resource[0].start; + +	/* Don't mention copyarea, so SCROLL_REDRAW is always +	 * used.  It is the fastest on this chip. +	 */ +	info->flags = (FBINFO_DEFAULT | +		       /* FBINFO_HWACCEL_COPYAREA | */ +		       FBINFO_HWACCEL_FILLRECT | +		       FBINFO_HWACCEL_IMAGEBLIT); + +	info->fbops = &ffb_ops; + +	info->screen_base = (char *) par->physbase + FFB_DFB24_POFF; +	info->pseudo_palette = par->pseudo_palette; + +	sbusfb_fill_var(&info->var, dp, 32); +	par->fbsize = PAGE_ALIGN(info->var.xres * info->var.yres * 4); +	ffb_fixup_var_rgb(&info->var); + +	info->var.accel_flags = FB_ACCELF_TEXT; + +	if (!strcmp(dp->name, "SUNW,afb")) +		par->flags |= FFB_FLAG_AFB; + +	par->board_type = of_getintprop_default(dp, "board_type", 0); + +	fbc = par->fbc; +	if ((upa_readl(&fbc->ucsr) & FFB_UCSR_ALL_ERRORS) != 0) +		upa_writel(FFB_UCSR_ALL_ERRORS, &fbc->ucsr); + +	dac = par->dac; +	upa_writel(FFB_DAC_DID, &dac->type); +	dac_pnum = upa_readl(&dac->value); +	dac_rev = (dac_pnum & FFB_DAC_DID_REV) >> FFB_DAC_DID_REV_SHIFT; +	dac_pnum = (dac_pnum & FFB_DAC_DID_PNUM) >> FFB_DAC_DID_PNUM_SHIFT; + +	upa_writel(FFB_DAC_UCTRL, &dac->type); +	dac_mrev = upa_readl(&dac->value); +	dac_mrev = (dac_mrev & FFB_DAC_UCTRL_MANREV) >> +		FFB_DAC_UCTRL_MANREV_SHIFT; + +	/* Elite3D has different DAC revision numbering, and no DAC revisions +	 * have the reversed meaning of cursor enable.  Otherwise, Pacifica 1 +	 * ramdacs with manufacturing revision less than 3 have inverted +	 * cursor logic.  We identify Pacifica 1 as not Pacifica 2, the +	 * latter having a part number value of 0x236e. +	 */ +	if ((par->flags & FFB_FLAG_AFB) || dac_pnum == 0x236e) { +		par->flags &= ~FFB_FLAG_INVCURSOR; +	} else { +		if (dac_mrev < 3) +			par->flags |= FFB_FLAG_INVCURSOR; +	} + +	ffb_switch_from_graph(par); + +	/* Unblank it just to be sure.  When there are multiple +	 * FFB/AFB cards in the system, or it is not the OBP +	 * chosen console, it will have video outputs off in +	 * the DAC. +	 */ +	ffb_blank(FB_BLANK_UNBLANK, info); + +	if (fb_alloc_cmap(&info->cmap, 256, 0)) +		goto out_unmap_dac; + +	ffb_init_fix(info); + +	err = register_framebuffer(info); +	if (err < 0) +		goto out_dealloc_cmap; + +	dev_set_drvdata(&op->dev, info); + +	printk(KERN_INFO "%s: %s at %016lx, type %d, " +	       "DAC pnum[%x] rev[%d] manuf_rev[%d]\n", +	       dp->full_name, +	       ((par->flags & FFB_FLAG_AFB) ? "AFB" : "FFB"), +	       par->physbase, par->board_type, +	       dac_pnum, dac_rev, dac_mrev); + +	return 0; + +out_dealloc_cmap: +	fb_dealloc_cmap(&info->cmap); + +out_unmap_dac: +	of_iounmap(&op->resource[1], par->dac, sizeof(struct ffb_dac)); + +out_unmap_fbc: +	of_iounmap(&op->resource[2], par->fbc, sizeof(struct ffb_fbc)); + +out_release_fb: +	framebuffer_release(info); + +out_err: +	return err; +} + +static int ffb_remove(struct platform_device *op) +{ +	struct fb_info *info = dev_get_drvdata(&op->dev); +	struct ffb_par *par = info->par; + +	unregister_framebuffer(info); +	fb_dealloc_cmap(&info->cmap); + +	of_iounmap(&op->resource[2], par->fbc, sizeof(struct ffb_fbc)); +	of_iounmap(&op->resource[1], par->dac, sizeof(struct ffb_dac)); + +	framebuffer_release(info); + +	return 0; +} + +static const struct of_device_id ffb_match[] = { +	{ +		.name = "SUNW,ffb", +	}, +	{ +		.name = "SUNW,afb", +	}, +	{}, +}; +MODULE_DEVICE_TABLE(of, ffb_match); + +static struct platform_driver ffb_driver = { +	.driver = { +		.name = "ffb", +		.owner = THIS_MODULE, +		.of_match_table = ffb_match, +	}, +	.probe		= ffb_probe, +	.remove		= ffb_remove, +}; + +static int __init ffb_init(void) +{ +	if (fb_get_options("ffb", NULL)) +		return -ENODEV; + +	return platform_driver_register(&ffb_driver); +} + +static void __exit ffb_exit(void) +{ +	platform_driver_unregister(&ffb_driver); +} + +module_init(ffb_init); +module_exit(ffb_exit); + +MODULE_DESCRIPTION("framebuffer driver for Creator/Elite3D chipsets"); +MODULE_AUTHOR("David S. Miller <davem@davemloft.net>"); +MODULE_VERSION("2.0"); +MODULE_LICENSE("GPL");  | 
