diff options
Diffstat (limited to 'drivers/video/fbdev/geode/display_gx1.c')
| -rw-r--r-- | drivers/video/fbdev/geode/display_gx1.c | 214 | 
1 files changed, 214 insertions, 0 deletions
diff --git a/drivers/video/fbdev/geode/display_gx1.c b/drivers/video/fbdev/geode/display_gx1.c new file mode 100644 index 00000000000..926d53eeb54 --- /dev/null +++ b/drivers/video/fbdev/geode/display_gx1.c @@ -0,0 +1,214 @@ +/* + * drivers/video/geode/display_gx1.c + *   -- Geode GX1 display controller + * + * Copyright (C) 2005 Arcom Control Systems Ltd. + * + * Based on AMD's original 2.4 driver: + *   Copyright (C) 2004 Advanced Micro Devices, Inc. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + */ +#include <linux/spinlock.h> +#include <linux/fb.h> +#include <linux/delay.h> +#include <asm/io.h> +#include <asm/div64.h> +#include <asm/delay.h> + +#include "geodefb.h" +#include "display_gx1.h" + +static DEFINE_SPINLOCK(gx1_conf_reg_lock); + +static u8 gx1_read_conf_reg(u8 reg) +{ +	u8 val, ccr3; +	unsigned long flags; + +	spin_lock_irqsave(&gx1_conf_reg_lock, flags); + +	outb(CONFIG_CCR3, 0x22); +	ccr3 = inb(0x23); +	outb(CONFIG_CCR3, 0x22); +	outb(ccr3 | CONFIG_CCR3_MAPEN, 0x23); +	outb(reg, 0x22); +	val = inb(0x23); +	outb(CONFIG_CCR3, 0x22); +	outb(ccr3, 0x23); + +	spin_unlock_irqrestore(&gx1_conf_reg_lock, flags); + +	return val; +} + +unsigned gx1_gx_base(void) +{ +	return (gx1_read_conf_reg(CONFIG_GCR) & 0x03) << 30; +} + +int gx1_frame_buffer_size(void) +{ +	void __iomem *mc_regs; +	u32 bank_cfg; +	int d; +	unsigned dram_size = 0, fb_base; + +	mc_regs = ioremap(gx1_gx_base() + 0x8400, 0x100); +	if (!mc_regs) +		return -ENOMEM; + + +	/* Calculate the total size of both DIMM0 and DIMM1. */ +	bank_cfg = readl(mc_regs + MC_BANK_CFG); + +	for (d = 0; d < 2; d++) { +		if ((bank_cfg & MC_BCFG_DIMM0_PG_SZ_MASK) != MC_BCFG_DIMM0_PG_SZ_NO_DIMM) +			dram_size += 0x400000 << ((bank_cfg & MC_BCFG_DIMM0_SZ_MASK) >> 8); +		bank_cfg >>= 16; /* look at DIMM1 next */ +	} + +	fb_base = (readl(mc_regs + MC_GBASE_ADD) & MC_GADD_GBADD_MASK) << 19; + +	iounmap(mc_regs); + +	return dram_size - fb_base; +} + +static void gx1_set_mode(struct fb_info *info) +{ +	struct geodefb_par *par = info->par; +	u32 gcfg, tcfg, ocfg, dclk_div, val; +	int hactive, hblankstart, hsyncstart, hsyncend, hblankend, htotal; +	int vactive, vblankstart, vsyncstart, vsyncend, vblankend, vtotal; + +	/* Unlock the display controller registers. */ +	readl(par->dc_regs + DC_UNLOCK); +	writel(DC_UNLOCK_CODE, par->dc_regs + DC_UNLOCK); + +	gcfg = readl(par->dc_regs + DC_GENERAL_CFG); +	tcfg = readl(par->dc_regs + DC_TIMING_CFG); + +	/* Blank the display and disable the timing generator. */ +	tcfg &= ~(DC_TCFG_BLKE | DC_TCFG_TGEN); +	writel(tcfg, par->dc_regs + DC_TIMING_CFG); + +	/* Wait for pending memory requests before disabling the FIFO load. */ +	udelay(100); + +	/* Disable FIFO load and compression. */ +	gcfg &= ~(DC_GCFG_DFLE | DC_GCFG_CMPE | DC_GCFG_DECE); +	writel(gcfg, par->dc_regs + DC_GENERAL_CFG); + +	/* Setup DCLK and its divisor. */ +	gcfg &= ~DC_GCFG_DCLK_MASK; +	writel(gcfg, par->dc_regs + DC_GENERAL_CFG); + +	par->vid_ops->set_dclk(info); + +	dclk_div = DC_GCFG_DCLK_DIV_1; /* FIXME: may need to divide DCLK by 2 sometimes? */ +	gcfg |= dclk_div; +	writel(gcfg, par->dc_regs + DC_GENERAL_CFG); + +	/* Wait for the clock generatation to settle.  This is needed since +	 * some of the register writes that follow require that clock to be +	 * present. */ +	udelay(1000); /* FIXME: seems a little long */ + +	/* +	 * Setup new mode. +	 */ + +	/* Clear all unused feature bits. */ +	gcfg = DC_GCFG_VRDY | dclk_div; + +	/* Set FIFO priority (default 6/5) and enable. */ +	/* FIXME: increase fifo priority for 1280x1024 modes? */ +	gcfg |= (6 << DC_GCFG_DFHPEL_POS) | (5 << DC_GCFG_DFHPSL_POS) | DC_GCFG_DFLE; + +	/* FIXME: Set pixel and line double bits if necessary. */ + +	/* Framebuffer start offset. */ +	writel(0, par->dc_regs + DC_FB_ST_OFFSET); + +	/* Line delta and line buffer length. */ +	writel(info->fix.line_length >> 2, par->dc_regs + DC_LINE_DELTA); +	writel(((info->var.xres * info->var.bits_per_pixel/8) >> 3) + 2, +	       par->dc_regs + DC_BUF_SIZE); + +	/* Output configuration. Enable panel data, set pixel format. */ +	ocfg = DC_OCFG_PCKE | DC_OCFG_PDEL | DC_OCFG_PDEH; +	if (info->var.bits_per_pixel == 8) ocfg |= DC_OCFG_8BPP; + +	/* Enable timing generator, sync and FP data. */ +	tcfg = DC_TCFG_FPPE | DC_TCFG_HSYE | DC_TCFG_VSYE | DC_TCFG_BLKE +		| DC_TCFG_TGEN; + +	/* Horizontal and vertical timings. */ +	hactive = info->var.xres; +	hblankstart = hactive; +	hsyncstart = hblankstart + info->var.right_margin; +	hsyncend =  hsyncstart + info->var.hsync_len; +	hblankend = hsyncend + info->var.left_margin; +	htotal = hblankend; + +	vactive = info->var.yres; +	vblankstart = vactive; +	vsyncstart = vblankstart + info->var.lower_margin; +	vsyncend =  vsyncstart + info->var.vsync_len; +	vblankend = vsyncend + info->var.upper_margin; +	vtotal = vblankend; + +	val = (hactive - 1) | ((htotal - 1) << 16); +	writel(val, par->dc_regs + DC_H_TIMING_1); +	val = (hblankstart - 1) | ((hblankend - 1) << 16); +	writel(val, par->dc_regs + DC_H_TIMING_2); +	val = (hsyncstart - 1) | ((hsyncend - 1) << 16); +	writel(val, par->dc_regs + DC_H_TIMING_3); +	writel(val, par->dc_regs + DC_FP_H_TIMING); +	val = (vactive - 1) | ((vtotal - 1) << 16); +	writel(val, par->dc_regs + DC_V_TIMING_1); +	val = (vblankstart - 1) | ((vblankend - 1) << 16); +	writel(val, par->dc_regs + DC_V_TIMING_2); +	val = (vsyncstart - 1) | ((vsyncend - 1) << 16); +	writel(val, par->dc_regs + DC_V_TIMING_3); +	val = (vsyncstart - 2) | ((vsyncend - 2) << 16); +	writel(val, par->dc_regs + DC_FP_V_TIMING); + +	/* Write final register values. */ +	writel(ocfg, par->dc_regs + DC_OUTPUT_CFG); +	writel(tcfg, par->dc_regs + DC_TIMING_CFG); +	udelay(1000); /* delay after TIMING_CFG. FIXME: perhaps a little long */ +	writel(gcfg, par->dc_regs + DC_GENERAL_CFG); + +	par->vid_ops->configure_display(info); + +	/* Relock display controller registers */ +	writel(0, par->dc_regs + DC_UNLOCK); + +	/* FIXME: write line_length and bpp to Graphics Pipeline GP_BLT_STATUS +	 * register. */ +} + +static void gx1_set_hw_palette_reg(struct fb_info *info, unsigned regno, +				   unsigned red, unsigned green, unsigned blue) +{ +	struct geodefb_par *par = info->par; +	int val; + +	/* Hardware palette is in RGB 6-6-6 format. */ +	val  = (red   <<  2) & 0x3f000; +	val |= (green >>  4) & 0x00fc0; +	val |= (blue  >> 10) & 0x0003f; + +	writel(regno, par->dc_regs + DC_PAL_ADDRESS); +	writel(val, par->dc_regs + DC_PAL_DATA); +} + +struct geode_dc_ops gx1_dc_ops = { +	.set_mode	 = gx1_set_mode, +	.set_palette_reg = gx1_set_hw_palette_reg, +};  | 
