Quelle  maxinefb.c   Sprache: C

/*
 *      linux/drivers/video/maxinefb.c
 *
 * DECstation 5000/xx onboard framebuffer support ... derived from:
 * "HP300 Topcat framebuffer support (derived from macfb of all things)
 * Phil Blundell <philb@gnu.org> 1998", the original code can be
 *      found in the file hpfb.c in the same directory.
 *
 *      DECstation related code Copyright (C) 1999,2000,2001 by
 *      Michael Engel <engel@unix-ag.org> and
 *      Karsten Merker <merker@linuxtag.org>.
 *      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.
 *
 */

/*
 * Changes:
 * 2001/01/27 removed debugging and testing code, fixed fb_ops
 *            initialization which had caused a crash before,
 *            general cleanup, first official release (KM)
 *
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/fb.h>
#include <video/maxinefb.h>

/* bootinfo.h defines the machine type values, needed when checking */
/* whether are really running on a maxine, KM                       */
#include <asm/bootinfo.h>

static struct fb_info fb_info;

static const struct fb_var_screeninfo maxinefb_defined = {
 .xres =  1024,
 .yres =  768,
 .xres_virtual = 1024,
 .yres_virtual = 768,
 .bits_per_pixel =8,
 .activate = FB_ACTIVATE_NOW,
 .height = -1,
 .width = -1,
 .vmode = FB_VMODE_NONINTERLACED,
};

static struct fb_fix_screeninfo maxinefb_fix __initdata = {
 .id =  "Maxine",
 .smem_len = (1024*768),
 .type =  FB_TYPE_PACKED_PIXELS,
 .visual = FB_VISUAL_PSEUDOCOLOR,
 .line_length = 1024,
};

/* Handle the funny Inmos RamDAC/video controller ... */

void maxinefb_ims332_write_register(int regno, register unsigned int val)
{
 register unsigned char *regs = (char *) MAXINEFB_IMS332_ADDRESS;
 unsigned char *wptr;

 wptr = regs + 0xa0000 + (regno << 4);
 *((volatile unsigned int *) (regs)) = (val >> 8) & 0xff00;
 *((volatile unsigned short *) (wptr)) = val;
}

unsigned int maxinefb_ims332_read_register(int regno)
{
 register unsigned char *regs = (char *) MAXINEFB_IMS332_ADDRESS;
 unsigned char *rptr;
 register unsigned int j, k;

 rptr = regs + 0x80000 + (regno << 4);
 j = *((volatile unsigned short *) rptr);
 k = *((volatile unsigned short *) regs);

 return (j & 0xffff) | ((k & 0xff00) << 8);
}

/* Set the palette */
static int maxinefb_setcolreg(unsigned regno, unsigned red, unsigned green,
         unsigned blue, unsigned transp, struct fb_info *info)
{
 /* value to be written into the palette reg. */
 unsigned long hw_colorvalue = 0;

 if (regno > 255)
  return 1;

 red   >>= 8;    /* The cmap fields are 16 bits    */
 green >>= 8;    /* wide, but the harware colormap */
 blue  >>= 8;    /* registers are only 8 bits wide */

 hw_colorvalue = (blue << 16) + (green << 8) + (red);

 maxinefb_ims332_write_register(IMS332_REG_COLOR_PALETTE + regno,
           hw_colorvalue);
 return 0;
}

static const struct fb_ops maxinefb_ops = {
 .owner  = THIS_MODULE,
 FB_DEFAULT_IOMEM_OPS,
 .fb_setcolreg = maxinefb_setcolreg,
};

int __init maxinefb_init(void)
{
 unsigned long fboff;
 unsigned long fb_start;
 int i;

 if (fb_get_options("maxinefb", NULL))
  return -ENODEV;

 /* Validate we're on the proper machine type */
 if (mips_machtype != MACH_DS5000_XX) {
  return -EINVAL;
 }

 printk(KERN_INFO "Maxinefb: Personal DECstation detected\n");
 printk(KERN_INFO "Maxinefb: initializing onboard framebuffer\n");

 /* Framebuffer display memory base address */
 fb_start = DS5000_xx_ONBOARD_FBMEM_START;

 /* Clear screen */
 for (fboff = fb_start; fboff < fb_start + 0x1ffff; fboff++)
  *(volatile unsigned char *)fboff = 0x0;

 maxinefb_fix.smem_start = fb_start;

 /* erase hardware cursor */
 for (i = 0; i < 512; i++) {
  maxinefb_ims332_write_register(IMS332_REG_CURSOR_RAM + i,
            0);
  /*
   if (i&0x8 == 0)
   maxinefb_ims332_write_register (IMS332_REG_CURSOR_RAM + i, 0x0f);
   else
   maxinefb_ims332_write_register (IMS332_REG_CURSOR_RAM + i, 0xf0);
 */
 }

 fb_info.fbops = &maxinefb_ops;
 fb_info.screen_base = (char *)maxinefb_fix.smem_start;
 fb_info.var = maxinefb_defined;
 fb_info.fix = maxinefb_fix;

 fb_alloc_cmap(&fb_info.cmap, 256, 0);

 if (register_framebuffer(&fb_info) < 0)
  return 1;
 return 0;
}

static void __exit maxinefb_exit(void)
{
 unregister_framebuffer(&fb_info);
}

#ifdef MODULE
MODULE_LICENSE("GPL");
#endif
module_init(maxinefb_init);
module_exit(maxinefb_exit);