patch-2.4.0-test2 linux/drivers/video/hitfb.c

• Lines: 370
• Date: Tue Jun 20 14:14:51 2000
• Orig file: v2.4.0-test1/linux/drivers/video/hitfb.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.4.0-test1/linux/drivers/video/hitfb.c linux/drivers/video/hitfb.c
@@ -0,0 +1,369 @@
+/*
+ * $Id: hitfb.c,v 1.1 2000/06/10 21:45:40 yaegashi Exp $
+ * linux/drivers/video/hitfb.c -- Hitachi LCD frame buffer device
+ * (C) 1999 Mihai Spatar
+ * (C) 2000 YAEGASHI Takeshi
+ *
+ *  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/sched.h>
+#include <linux/errno.h>
+#include <linux/string.h>
+#include <linux/mm.h>
+#include <linux/tty.h>
+#include <linux/malloc.h>
+#include <linux/delay.h>
+#include <linux/nubus.h>
+#include <linux/init.h>
+
+#include <asm/uaccess.h>
+#include <asm/pgtable.h>
+#include <asm/io.h>
+
+#include <linux/fb.h>
+
+#include <video/fbcon.h>
+#include <video/fbcon-cfb8.h>
+#include <video/fbcon-cfb16.h>
+
+#include <asm/hd64461.h>
+
+#define CONFIG_SH_LCD_VIDEOBASE		CONFIG_HD64461_IOBASE+0x2000000
+
+/* These are for HP Jornada 680/690.
+   It is desired that they are configurable...  */
+#define CONFIG_SH_LCD_VIDEOSIZE		1024*1024
+#define CONFIG_SH_LCD_HORZ		640
+#define CONFIG_SH_LCD_VERT		240
+#define CONFIG_SH_LCD_DEFAULTBPP	16
+
+struct hitfb_info {
+    struct fb_info_gen gen;
+};
+
+struct hitfb_par
+{
+    int x, y;
+    int bpp;
+};
+
+static struct hitfb_info fb_info;
+static struct hitfb_par current_par;
+static int current_par_valid = 0;
+static struct display disp;
+
+static union {
+#ifdef FBCON_HAS_CFB16
+    u16 cfb16[16];
+#endif
+} fbcon_cmap;
+
+unsigned long hit_videobase, hit_videosize;
+static struct fb_var_screeninfo default_var;
+
+int hitfb_init(void);
+int hitfb_setup(char*);
+
+static void hitfb_set_par(struct hitfb_par *par, const struct fb_info *info);
+static void hitfb_encode_var(struct fb_var_screeninfo *var, 
+			     struct hitfb_par *par,
+			     const struct fb_info *info);
+
+
+static void hitfb_detect(void)
+{
+    struct hitfb_par par;
+
+    hit_videobase = CONFIG_SH_LCD_VIDEOBASE;
+    hit_videosize = CONFIG_SH_LCD_VIDEOSIZE;
+
+    par.x = CONFIG_SH_LCD_HORZ;
+    par.y = CONFIG_SH_LCD_VERT;
+    par.bpp = CONFIG_SH_LCD_DEFAULTBPP;
+
+    hitfb_set_par(&par, NULL);
+    hitfb_encode_var(&default_var, &par, NULL);
+}
+
+static int hitfb_encode_fix(struct fb_fix_screeninfo *fix,
+			    struct hitfb_par *par,
+			    const struct fb_info *info)
+{
+    memset(fix, 0, sizeof(struct fb_fix_screeninfo));
+
+    strcpy(fix->id, "Hitachi HD64461");
+    fix->smem_start = hit_videobase;
+    fix->smem_len = hit_videosize;
+    fix->type = FB_TYPE_PACKED_PIXELS;
+    fix->type_aux = 0;
+    fix->visual = FB_VISUAL_TRUECOLOR;
+    fix->xpanstep = 0;
+    fix->ypanstep = 0;
+    fix->ywrapstep = 0;
+
+    switch(par->bpp) {
+    default:
+    case 8:
+	fix->line_length = par->x;
+    case 16:
+	fix->line_length = par->x*2;
+    }
+
+    return 0;
+}
+
+
+static int hitfb_decode_var(struct fb_var_screeninfo *var,
+			    struct hitfb_par *par,
+			    const struct fb_info *info)
+{
+    par->x = var->xres;
+    par->y = var->yres;
+    par->bpp = var->bits_per_pixel;
+    return 0;
+}
+
+
+static void hitfb_encode_var(struct fb_var_screeninfo *var, 
+			     struct hitfb_par *par,
+			     const struct fb_info *info)
+{
+    memset(var, 0, sizeof(*var));
+
+    var->xres = par->x;
+    var->yres = par->y;
+    var->xres_virtual = var->xres;
+    var->yres_virtual = var->yres;
+    var->xoffset = 0;
+    var->yoffset = 0;
+    var->bits_per_pixel = par->bpp;
+    var->grayscale = 0;
+    var->transp.offset = 0;
+    var->transp.length = 0;
+    var->transp.msb_right = 0;
+    var->nonstd = 0;
+    var->activate = 0;
+    var->height = -1;
+    var->width = -1;
+    var->vmode = FB_VMODE_NONINTERLACED;
+    var->pixclock = 0;
+    var->sync = 0;
+    var->left_margin = 0;
+    var->right_margin = 0;
+    var->upper_margin = 0;
+    var->lower_margin = 0;
+    var->hsync_len = 0;
+    var->vsync_len = 0;
+
+    switch (var->bits_per_pixel) {
+
+	case 8:
+	    var->red.offset = 0;
+	    var->red.length = 8;
+	    var->green.offset = 0;
+	    var->green.length = 8;
+	    var->blue.offset = 0;
+	    var->blue.length = 8;
+	    var->transp.offset = 0;
+	    var->transp.length = 0;
+	    break;
+
+	case 16:	/* RGB 565 */
+	    var->red.offset = 11;
+	    var->red.length = 5;
+	    var->green.offset = 5;
+	    var->green.length = 6;
+	    var->blue.offset = 0;
+	    var->blue.length = 5;
+	    var->transp.offset = 0;
+	    var->transp.length = 0;
+	    break;
+    }
+
+    var->red.msb_right = 0;
+    var->green.msb_right = 0;
+    var->blue.msb_right = 0;
+    var->transp.msb_right = 0;
+}
+
+
+static void hitfb_get_par(struct hitfb_par *par, const struct fb_info *info)
+{
+    *par = current_par;
+}
+
+
+static void hitfb_set_par(struct hitfb_par *par, const struct fb_info *info)
+{
+    /* Set the hardware according to 'par'. */
+    current_par = *par;
+    current_par_valid = 1;
+}
+
+
+static int hitfb_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;	
+
+    outw(regno<<8, HD64461_CPTRAR);
+    *red = inw(HD64461_CPTRDR)<<10;
+    *green = inw(HD64461_CPTRDR)<<10;
+    *blue = inw(HD64461_CPTRDR)<<10;
+    *transp = 0;
+    
+    return 0;
+}
+
+
+static int hitfb_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;
+    
+    outw(regno<<8, HD64461_CPTWAR);
+    outw(red>>10, HD64461_CPTWDR);
+    outw(green>>10, HD64461_CPTWDR);
+    outw(blue>>10, HD64461_CPTWDR);
+    
+    if(regno<16) {
+	switch(current_par.bpp) {
+#ifdef FBCON_HAS_CFB16
+	case 16:
+	    fbcon_cmap.cfb16[regno] =
+		((red   & 0xf800)      ) |
+		((green & 0xfc00) >>  5) |
+		((blue  & 0xf800) >> 11);
+	    break;
+#endif
+	}
+    }
+
+    return 0;
+}
+
+static int hitfb_pan_display(struct fb_var_screeninfo *var,
+			     struct hitfb_par *par, const struct fb_info *info)
+{
+    if (var->xoffset || var->yoffset)
+	return -EINVAL;
+    else
+	return 0;
+}
+
+
+static int hitfb_blank(int blank_mode, const struct fb_info *info)
+{
+    return 0;
+}
+
+
+static void hitfb_set_disp(const void *par, struct display *disp,
+			   struct fb_info_gen *info)
+{
+    disp->screen_base = (void *)hit_videobase;
+    switch(((struct hitfb_par *)par)->bpp) {
+#ifdef FBCON_HAS_CFB8
+    case 8:
+	disp->dispsw = &fbcon_cfb8;
+	break;
+#endif
+#ifdef FBCON_HAS_CFB16
+    case 16:
+	disp->dispsw = &fbcon_cfb16;
+	disp->dispsw_data = fbcon_cmap.cfb16;
+	break;
+#endif
+    default:
+	disp->dispsw = &fbcon_dummy;
+    }
+}
+
+
+struct fbgen_hwswitch hitfb_switch = {
+    hitfb_detect,
+    hitfb_encode_fix,
+    hitfb_decode_var,
+    hitfb_encode_var,
+    hitfb_get_par,
+    hitfb_set_par,
+    hitfb_getcolreg,
+    hitfb_setcolreg,
+    hitfb_pan_display,
+    hitfb_blank,
+    hitfb_set_disp
+};
+
+static struct fb_ops hitfb_ops = {
+	owner:		THIS_MODULE,
+	fb_get_fix:	fbgen_get_fix,
+	fb_get_var:	fbgen_get_var,
+	fb_set_var:	fbgen_set_var,
+	fb_get_cmap:	fbgen_get_cmap,
+	fb_set_cmap:	fbgen_set_cmap,
+	fb_pan_display:	fbgen_pan_display,
+	fb_ioctl:	fbgen_ioctl,
+};
+
+
+int __init hitfb_init(void)
+{
+    strcpy(fb_info.gen.info.modename, "Hitachi HD64461");
+    fb_info.gen.info.node = -1;
+    fb_info.gen.info.flags = FBINFO_FLAG_DEFAULT;
+    fb_info.gen.info.fbops = &hitfb_ops;
+    fb_info.gen.info.disp = &disp;
+    fb_info.gen.info.changevar = NULL;
+    fb_info.gen.info.switch_con = &fbgen_switch;
+    fb_info.gen.info.updatevar = &fbgen_update_var;
+    fb_info.gen.info.blank = &fbgen_blank;
+    fb_info.gen.parsize = sizeof(struct hitfb_par);
+    fb_info.gen.fbhw = &hitfb_switch;
+    fb_info.gen.fbhw->detect();
+    
+    fbgen_get_var(&disp.var, -1, &fb_info.gen.info);
+    disp.var.activate = FB_ACTIVATE_NOW;
+    fbgen_do_set_var(&disp.var, 1, &fb_info.gen);
+    fbgen_set_disp(-1, &fb_info.gen);
+    fbgen_install_cmap(0, &fb_info.gen);
+    
+    if(register_framebuffer(&fb_info.gen.info)<0) return -EINVAL;
+    
+    printk(KERN_INFO "fb%d: %s frame buffer device\n",
+	   GET_FB_IDX(fb_info.gen.info.node), fb_info.gen.info.modename);
+    
+    return 0;
+}
+
+
+void hitfb_cleanup(struct fb_info *info)
+{
+    unregister_framebuffer(info);
+}
+
+
+int __init hitfb_setup(char *options)
+{
+    return 0;
+}
+
+
+#ifdef MODULE
+int init_module(void)
+{
+    return hitfb_init();
+}
+
+void cleanup_module(void)
+{
+    hitfb_cleanup(void);
+}
+#endif