patch-2.4.10 linux/drivers/video/tx3912fb.c

• Lines: 530
• Date: Fri Sep 7 09:28:38 2001
• Orig file: v2.4.9/linux/drivers/video/tx3912fb.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.4.9/linux/drivers/video/tx3912fb.c linux/drivers/video/tx3912fb.c
@@ -0,0 +1,529 @@
+/*
+ * linux/drivers/video/tx3912fb.c
+ *
+ * Copyright (C) 1999 Harald Koerfgen
+ * Copyright (C) 2001 Steven Hill (sjhill@realitydiluted.com)
+ *
+ * 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.
+ *
+ * Framebuffer for LCD controller in TMPR3912/05 and PR31700 processors
+ */
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/errno.h>
+#include <linux/string.h>
+#include <linux/tty.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/init.h>
+#include <linux/pm.h>
+#include <linux/fb.h>
+#include <asm/bootinfo.h>
+#include <asm/uaccess.h>
+#include <video/fbcon.h>
+#include <video/fbcon-mfb.h>
+#include <video/fbcon-cfb2.h>
+#include <video/fbcon-cfb4.h>
+#include <video/fbcon-cfb8.h>
+#include "tx3912fb.h"
+
+/*
+ * Frame buffer, palette and console structures
+ */
+static struct fb_info fb_info;
+static struct { u_char red, green, blue, pad; } palette[256];
+static struct display global_disp;
+static int currcon = 0;
+
+/*
+ * Interface used by the world
+ */
+static int tx3912fb_get_fix(struct fb_fix_screeninfo *fix, int con,
+				struct fb_info *info);
+static int tx3912fb_get_var(struct fb_var_screeninfo *var, int con,
+				struct fb_info *info);
+static int tx3912fb_set_var(struct fb_var_screeninfo *var, int con,
+				struct fb_info *info);
+static int tx3912fb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
+				struct fb_info *info);
+static int tx3912fb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
+				struct fb_info *info);
+static int tx3912fb_ioctl(struct inode *inode, struct file *file, u_int cmd,
+				u_long arg, int con, struct fb_info *info);
+
+/*
+ * Interface used by console driver
+ */
+int tx3912fb_init(void);
+static int tx3912fbcon_switch(int con, struct fb_info *info);
+static int tx3912fbcon_updatevar(int con, struct fb_info *info);
+static void tx3912fbcon_blank(int blank, struct fb_info *info);
+
+/*
+ * Macros
+ */
+#define get_line_length(xres_virtual, bpp) \
+		(u_long) (((int) xres_virtual * (int) bpp + 7) >> 3)
+
+/*
+ * Internal routines
+ */
+static int tx3912fb_getcolreg(u_int regno, u_int *red, u_int *green,
+			u_int *blue, u_int *transp, struct fb_info *info);
+static int tx3912fb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
+			u_int transp, struct fb_info *info);
+static void tx3912fb_install_cmap(int con, struct fb_info *info);
+
+
+/*
+ * Frame buffer operations structure used by console driver
+ */
+static struct fb_ops tx3912fb_ops = {
+	owner: THIS_MODULE,
+	fb_get_fix: tx3912fb_get_fix,
+	fb_get_var: tx3912fb_get_var,
+	fb_set_var: tx3912fb_set_var,
+	fb_get_cmap: tx3912fb_get_cmap,
+	fb_set_cmap: tx3912fb_set_cmap,
+	fb_ioctl: tx3912fb_ioctl,
+};
+
+
+/*
+ *  Get fixed display data
+ */
+static int tx3912fb_get_fix(struct fb_fix_screeninfo *fix, int con,
+				struct fb_info *info)
+{
+	struct display *display;
+
+	memset(fix, 0, sizeof(struct fb_fix_screeninfo));
+	strcpy(fix->id, TX3912FB_NAME);
+
+	if (con == -1)
+		display = &global_disp;
+	else
+		display = &fb_display[con];
+
+	fix->smem_start		= tx3912fb_vaddr;
+	fix->smem_len		= tx3912fb_size;
+	fix->type		= display->type;
+	fix->type_aux		= display->type_aux;
+	fix->xpanstep		= 0;
+	fix->ypanstep		= display->ypanstep;
+	fix->ywrapstep		= display->ywrapstep;
+	fix->visual		= display->visual;
+	fix->line_length	= display->line_length;
+	fix->accel		= FB_ACCEL_NONE;
+
+	return 0;
+}
+
+/*
+ * Get user display data
+ */
+static int tx3912fb_get_var(struct fb_var_screeninfo *var, int con,
+				struct fb_info *info)
+{
+	if (con == -1)
+		*var = tx3912fb_info;
+	else
+		*var = fb_display[con].var;
+
+	return 0;
+}
+
+/*
+ *  Set user display data
+ */
+static int tx3912fb_set_var(struct fb_var_screeninfo *var, int con,
+				struct fb_info *info)
+{
+	int err, activate = var->activate;
+	int oldxres, oldyres, oldvxres, oldvyres, oldbpp;
+	u_long line_length;
+	struct display *display;
+
+	if (con == -1)
+		display = &global_disp;
+	else
+		display = &fb_display[con];
+
+	/*
+	 * FB_VMODE_CONUPDATE and FB_VMODE_SMOOTH_XPAN are equal
+	 * as FB_VMODE_SMOOTH_XPAN is only used internally
+	 */
+	if (var->vmode & FB_VMODE_CONUPDATE) {
+		var->xoffset = display->var.xoffset;
+		var->yoffset = display->var.yoffset;
+		var->vmode |= FB_VMODE_YWRAP;
+	}
+
+	/*
+	 * Make sure values are in range
+	 */
+	if (!var->xres)
+		var->xres = 1;
+	if (!var->yres)
+		var->yres = 1;
+	if (var->xres > var->xres_virtual)
+		var->xres_virtual = var->xres;
+	if (var->yres > var->yres_virtual)
+		var->yres_virtual = var->yres;
+	if (var->bits_per_pixel <= 1)
+		var->bits_per_pixel = 1;
+	else if (var->bits_per_pixel <= 2)
+		var->bits_per_pixel = 2;
+	else if (var->bits_per_pixel <= 4)
+		var->bits_per_pixel = 4;
+	else if (var->bits_per_pixel <= 8)
+		var->bits_per_pixel = 8;
+	else
+		return -EINVAL;
+
+	/*
+	 * Memory limit
+	 */
+	line_length = get_line_length(var->xres_virtual, var->bits_per_pixel);
+	if ((line_length * var->yres_virtual) > tx3912fb_size)
+		return -ENOMEM;
+
+	/*
+	 * This is only for color and we only support 8-bit color
+	 */
+	if (var->bits_per_pixel) {
+		/* RGB 332 */
+		var->red.offset = 5;
+		var->red.length = 3;
+		var->green.offset = 2;
+		var->green.length = 3;
+		var->blue.offset = 0;
+		var->blue.length = 2;
+		var->transp.offset = 0;
+		var->transp.length = 0;
+	}
+	var->red.msb_right = 0;
+	var->green.msb_right = 0;
+	var->blue.msb_right = 0;
+	var->transp.msb_right = 0;
+
+	/*
+	 * Make changes if necessary
+	 */
+	if ((activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
+
+		oldxres = display->var.xres;
+		oldyres = display->var.yres;
+		oldvxres = display->var.xres_virtual;
+		oldvyres = display->var.yres_virtual;
+		oldbpp = display->var.bits_per_pixel;
+		display->var = *var;
+
+		if (oldxres != var->xres || oldyres != var->yres ||
+		    oldvxres != var->xres_virtual ||
+		    oldvyres != var->yres_virtual ||
+		    oldbpp != var->bits_per_pixel) {
+
+			display->screen_base = (u_char *) tx3912fb_vaddr;
+
+			switch (var->bits_per_pixel) {
+			case 1:
+				display->visual = FB_VISUAL_MONO10;
+				break;
+			case 2:
+				display->visual = FB_VISUAL_PSEUDOCOLOR;
+			case 4:
+			case 8:
+				display->visual = FB_VISUAL_TRUECOLOR;
+				break;
+			}
+
+			display->type = FB_TYPE_PACKED_PIXELS;
+			display->type_aux = 0;
+			display->ypanstep = 0;
+			display->ywrapstep = 0;
+			display->next_line =
+			display->line_length =
+				get_line_length(var->xres_virtual,
+					var->bits_per_pixel);
+			display->can_soft_blank = 0;
+			display->inverse = FB_IS_INVERSE;
+
+			switch (var->bits_per_pixel) {
+#ifdef CONFIG_FBCON_MFB
+			case 1:
+				display->dispsw = &fbcon_mfb;
+				break;
+#endif
+#ifdef CONFIG_FBCON_CFB2
+			case 2:
+				display->dispsw = &fbcon_cfb2;
+				break;
+#endif
+#ifdef CONFIG_FBCON_CFB4
+			case 4:
+				display->dispsw = &fbcon_cfb4;
+				break;
+#endif
+#ifdef CONFIG_FBCON_CFB8
+			case 8:
+				display->dispsw = &fbcon_cfb8;
+				display->dispsw_data = fbcon_cmap.cfb8;
+				break;
+#endif
+			default:
+				display->dispsw = &fbcon_dummy;
+				break;
+	    		}
+
+			if (fb_info.changevar)
+				(*fb_info.changevar)(con);
+		}
+
+		if (oldbpp != var->bits_per_pixel) {
+			if ((err = fb_alloc_cmap(&display->cmap, 0, 0)))
+				return err;
+			tx3912fb_install_cmap(con, info);
+		}
+	}
+
+	return 0;
+}
+
+/*
+ *  Get the colormap
+ */
+static int tx3912fb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
+			struct fb_info *info)
+{
+	if (con == currcon)
+		return fb_get_cmap(cmap, kspc, tx3912fb_getcolreg, info);
+	else if (fb_display[con].cmap.len) /* non default colormap? */
+		fb_copy_cmap(&fb_display[con].cmap, cmap, kspc ? 0 : 2);
+	else
+		fb_copy_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel), cmap, kspc ? 0 : 2);
+
+	return 0;
+}
+
+/*
+ *  Set the Colormap
+ */
+static int tx3912fb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
+			struct fb_info *info)
+{
+	int err;
+
+	if (!fb_display[con].cmap.len)
+		if ((err = fb_alloc_cmap(&fb_display[con].cmap,
+				1<<fb_display[con].var.bits_per_pixel, 0)))
+			return err;
+
+	if (con == currcon)
+		return fb_set_cmap(cmap, kspc, tx3912fb_setcolreg, info);
+	else
+		fb_copy_cmap(cmap, &fb_display[con].cmap, kspc ? 0 : 1);
+
+	return 0;
+}
+
+/*
+ *  Framebuffer ioctl
+ */
+static int tx3912fb_ioctl(struct inode *inode, struct file *file, u_int cmd,
+				u_long arg, int con, struct fb_info *info)
+{
+	return -EINVAL;
+}
+
+/*
+ * Initialization of the framebuffer
+ */
+int __init tx3912fb_init(void)
+{
+	/* Stop the video logic when frame completes */
+	VidCtrl1 |= ENFREEZEFRAME;
+	IntClear1 |= INT1_LCDINT;
+	while (!(IntStatus1 & INT1_LCDINT));
+
+	/* Disable the video logic */
+	VidCtrl1 &= ~(ENVID | DISPON);
+	udelay(200);
+
+	/* Set start address for DMA transfer */
+	VidCtrl3 = tx3912fb_paddr &
+		(TX3912_VIDCTRL3_VIDBANK_MASK | TX3912_VIDCTRL3_VIDBASEHI_MASK);
+
+	/* Set end address for DMA transfer */
+	VidCtrl4 = (tx3912fb_paddr + tx3912fb_size + 1) &
+		TX3912_VIDCTRL4_VIDBASELO_MASK;
+
+	/* Set the pixel depth */
+	switch (tx3912fb_info.bits_per_pixel) {
+	case 1:
+		/* Monochrome */
+		VidCtrl1 &= ~TX3912_VIDCTRL1_BITSEL_MASK;
+		break;
+	case 4:
+		/* 4-bit gray */
+		VidCtrl1 &= ~TX3912_VIDCTRL1_BITSEL_MASK;
+		VidCtrl1 |= TX3912_VIDCTRL1_4BIT_GRAY;
+		break;
+	case 8:
+		/* 8-bit color */
+		VidCtrl1 &= ~TX3912_VIDCTRL1_BITSEL_MASK;
+		VidCtrl1 |= TX3912_VIDCTRL1_8BIT_COLOR;
+		break;
+	case 2:
+	default:
+		/* 2-bit gray */
+		VidCtrl1 &= ~TX3912_VIDCTRL1_BITSEL_MASK;
+		VidCtrl1 |= TX3912_VIDCTRL1_2BIT_GRAY;
+		break;
+	}
+
+	/* Unfreeze video logic and enable DF toggle */
+	VidCtrl1 &= ~(ENFREEZEFRAME | DFMODE);
+	udelay(200);
+
+	/* Clear the framebuffer */
+	memset((void *) tx3912fb_vaddr, 0xff, tx3912fb_size);
+	udelay(200);
+
+	/* Enable the video logic */
+	VidCtrl1 |= (DISPON | ENVID);
+
+	strcpy(fb_info.modename, TX3912FB_NAME);
+	fb_info.changevar = NULL;
+	fb_info.node = -1;
+	fb_info.fbops = &tx3912fb_ops;
+	fb_info.disp = &global_disp;
+	fb_info.switch_con = &tx3912fbcon_switch;
+	fb_info.updatevar = &tx3912fbcon_updatevar;
+	fb_info.blank = &tx3912fbcon_blank;
+	fb_info.flags = FBINFO_FLAG_DEFAULT;
+
+	tx3912fb_set_var(&tx3912fb_info, -1, &fb_info);
+
+	if (register_framebuffer(&fb_info) < 0)
+		return -1;
+
+	printk (KERN_INFO "fb%d: TX3912 frame buffer using %uKB.\n",
+		GET_FB_IDX(fb_info.node), (u_int) (tx3912fb_size >> 10));
+
+	return 0;
+}
+
+/*
+ * Switch the console to be the framebuffer
+ */
+static int tx3912fbcon_switch(int con, struct fb_info *info)
+{
+	/* Save off the color map if needed */
+	if (fb_display[currcon].cmap.len)
+		fb_get_cmap(&fb_display[currcon].cmap, 1,
+			tx3912fb_getcolreg, info);
+
+	/* Make the switch */
+	currcon = con;
+
+	/* Install new colormap */
+	tx3912fb_install_cmap(con, info);
+
+	return 0;
+}
+
+/*
+ * Update variable structure
+ */
+static int tx3912fbcon_updatevar(int con, struct fb_info *info)
+{
+	/* Nothing */
+	return 0;
+}
+
+/*
+ * Blank the display
+ */
+static void tx3912fbcon_blank(int blank, struct fb_info *info)
+{
+	/* FIXME */
+	printk("tx3912fbcon_blank\n");
+}
+
+/*
+ * Read a single color register
+ */
+static int tx3912fb_getcolreg(u_int regno, u_int *red, u_int *green,
+			u_int *blue, u_int *transp, struct fb_info *info)
+{
+	if (regno > 255)
+		return 1;
+
+#if FB_IS_GREY
+	{
+		u_int grey;
+            
+		grey = regno * 255 / 15;
+
+#if FB_IS_INVERSE
+		grey ^= 255;
+#endif
+		grey |= grey << 8;
+		*red = grey;
+		*green = grey;
+		*blue = grey;
+	}
+#else
+	*red = (palette[regno].red<<8) | palette[regno].red;
+	*green = (palette[regno].green<<8) | palette[regno].green;
+	*blue = (palette[regno].blue<<8) | palette[regno].blue;
+#endif
+	*transp = 0;
+
+	return 0;
+}
+
+/*
+ * Set a single color register
+ */
+static int tx3912fb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
+				u_int transp, struct fb_info *info)
+{
+	if (regno > 255)
+		return 1;
+
+#ifdef FBCON_HAS_CFB8
+	if( regno < 16 )
+		fbcon_cmap.cfb8[regno] = ((red & 0xe000) >> 8)
+					| ((green & 0xe000) >> 11)
+					| ((blue & 0xc000) >> 14);
+#endif 
+
+	red >>= 8;
+	green >>= 8;
+	blue >>= 8;
+	palette[regno].red = red;
+	palette[regno].green = green;
+	palette[regno].blue = blue;
+
+	return 0;
+}
+
+/*
+ * Install the color map
+ */
+static void tx3912fb_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, tx3912fb_setcolreg, info);
+	else
+		fb_set_cmap(fb_default_cmap(1 << fb_display[con].var.bits_per_pixel), 1, tx3912fb_setcolreg, info);
+}
+
+MODULE_LICENSE("GPL");