Subversion Repositories or1k

/*

 * linux/arch/or32/console/crtfb.c -- Low level implementation of the

 *                                           crt frame buffer device

 *

 *  Copyright (C) 2001,2002 Simon Srot <srot@opencores.org>,

 *                          www.opencores.org

 *

 * This file is based on the m68328 frame buffer LCD device (68328fb.c):

 *

 *    Copyright (C) 1998,1999 Kenneth Albanowski <kjahds@kjahds.com>,

 *                            The Silver Hammer Group, Ltd.

 *

 *

 * This file is based on the Amiga CyberVision frame buffer device (Cyberfb.c):

 *

 *    Copyright (C) 1996 Martin Apel

 *                       Geert Uytterhoeven

 *

 *

 * This file is based on the Amiga frame buffer device (amifb.c):

 *

 *    Copyright (C) 1995 Geert Uytterhoeven

 *

 *

 * 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/kernel.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/config.h>

#include <asm/segment.h>

#include <asm/system.h>

#include <asm/irq.h>

#include <asm/pgtable.h>

#include <asm/io.h>

#include <linux/fb.h>

#define LCD 0

#define arraysize(x)    (sizeof(x)/sizeof(*(x)))

struct crt_fb_par {

   int xres;

   int yres;

   int bpp;

};

static struct crt_fb_par current_par;

static int current_par_valid = 0;

static int currcon = 0;

static struct display disp[MAX_NR_CONSOLES];

static struct fb_info fb_info;

static int node;        /* node of the /dev/fb?current file */

   /*

    *    Switch for Chipset Independency

    */

static struct fb_hwswitch {

   /* Initialisation */

   int (*init)(void);

   /* Display Control */

   int (*encode_fix)(struct fb_fix_screeninfo *fix, struct crt_fb_par *par);

   int (*decode_var)(struct fb_var_screeninfo *var, struct crt_fb_par *par);

   int (*encode_var)(struct fb_var_screeninfo *var, struct crt_fb_par *par);

   int (*getcolreg)(u_int regno, u_int *red, u_int *green, u_int *blue,

                    u_int *transp);

   int (*setcolreg)(u_int regno, u_int red, u_int green, u_int blue,

                    u_int transp);

   void (*blank)(int blank);

} *fbhw;

   /*

    *    Frame Buffer Name

    */

static char crt_fb_name[16] = "crt";

   /*

    *    crtvision Graphics Board

    */

#define CRT_CTL_REG (CRT_BASE_ADD + 0)

#define CRT_FB_BASE_REG (CRT_BASE_ADD + 4)

#define CRT_PAL_PTR  ((unsigned long *)(CRT_BASE_ADD + 0x400))

#define setpal(i,r,g,b) *(CRT_PAL_PTR + (i)) = ((((unsigned long)(r) & 0xff)) << 11) | \

                                               ((((unsigned long)(g) & 0xff)) << 5)  | \

                                               ((((unsigned long)(b) & 0xff)) << 0)

#if LCD

#define CRT_WIDTH 320

#define CRT_HEIGHT 240

#else

#define CRT_WIDTH 640

#define CRT_HEIGHT 480

#endif

static int crtKey = 0;

static u_char crt_colour_table [256][4];

static unsigned long crtMem;

static unsigned long crtSize;

static long *memstart;

   /*

    *    Predefined Video Mode Names

    */

static char *crt_fb_modenames[] = {

   /*

    *    Autodetect (Default) Video Mode

    */

   "default",

   /*

    *    Predefined Video Modes

    */

   "CRT",

   /*

    *    Dummy Video Modes

    */

   "dummy", "dummy", "dummy", "dummy", "dummy", "dummy", "dummy", "dummy",

   "dummy", "dummy", "dummy", "dummy", "dummy", "dummy", "dummy", "dummy",

   "dummy", "dummy", "dummy", "dummy",

   /*

    *    User Defined Video Modes

    *

    *    This doesn't work yet!!

    */

   "user0", "user1", "user2", "user3", "user4", "user5", "user6", "user7"

};

   /*

    *    Predefined Video Mode Definitions

    */

static struct fb_var_screeninfo crt_fb_predefined[] = {

   /*

    *    Autodetect (Default) Video Mode

    */

   { 0, },

   /*

    *    Predefined Video Modes

    */

   {

      /* CRT */

      CRT_WIDTH, CRT_HEIGHT, CRT_WIDTH, CRT_HEIGHT,

      0, 0,

      8, 0,

      {0, 2, 0}, {0, 2, 0}, {0, 2, 0}, {0, 0, 0},

      0, FB_ACTIVATE_NOW,

      -1, -1, /* phys height, width */

      FB_ACCEL_NONE,

      0, 0, 0, 0, 0, 0, 0, /* timing */

      0, /* sync */

      FB_VMODE_NONINTERLACED

   },

   /*

    *    Dummy Video Modes

    */

   { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, },

   { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, },

   { 0, }, { 0, },

   /*

    *    User Defined Video Modes

    */

   { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }, { 0, }

};

#define NUM_TOTAL_MODES    arraysize(crt_fb_predefined)

#define NUM_PREDEF_MODES   (2)

static int crtfb_inverse = 0xf;

static int crtfb_mode = 0;

static int crtfbCursorMode = 0;

   /*

    *    Some default modes

    */

#define CRT_DEFMODE     (1)

   /*

    *    Interface used by the world

    */

void crt_video_setup(char *options, int *ints);

static int crt_fb_get_fix(struct fb_fix_screeninfo *fix, int con);

static int crt_fb_get_var(struct fb_var_screeninfo *var, int con);

static int crt_fb_set_var(struct fb_var_screeninfo *var, int con);

static int crt_fb_get_cmap(struct fb_cmap *cmap, int kspc, int con);

static int crt_fb_set_cmap(struct fb_cmap *cmap, int kspc, int con);

static int crt_fb_pan_display(struct fb_var_screeninfo *var, int con);

static int crt_fb_ioctl(struct inode *inode, struct file *file, u_int cmd,

                          u_long arg, int con);

   /*

    *    Interface to the low level console driver

    */

struct fb_info *crt_fb_init(long *mem_start); /* Through amiga_fb_init() */

static int crtfb_switch(int con);

static int crtfb_updatevar(int con);

static void crtfb_blank(int blank);

   /*

    *    Accelerated Functions used by the low level console driver

    */

void crt_WaitQueue(u_short fifo);

void crt_WaitBlit(void);

void crt_BitBLT(u_short curx, u_short cury, u_short destx, u_short desty,

                  u_short width, u_short height, u_short mode);

void crt_RectFill(u_short x, u_short y, u_short width, u_short height,

                    u_short mode, u_short color);

void crt_MoveCursor(u_short x, u_short y);

   /*

    *   Hardware Specific Routines

    */

static int crt_init(void);

static int crt_encode_fix(struct fb_fix_screeninfo *fix,

                          struct crt_fb_par *par);

static int crt_decode_var(struct fb_var_screeninfo *var,

                          struct crt_fb_par *par);

static int crt_encode_var(struct fb_var_screeninfo *var,

                          struct crt_fb_par *par);

static int crt_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,

                         u_int *transp);

static int crt_setcolreg(u_int regno, u_int red, u_int green, u_int blue,

                         u_int transp);

static void crt_blank(int blank);

   /*

    *    Internal routines

    */

static void crt_fb_get_par(struct crt_fb_par *par);

static void crt_fb_set_par(struct crt_fb_par *par);

static int do_fb_set_var(struct fb_var_screeninfo *var, int isactive);

static struct fb_cmap *get_default_colormap(int bpp);

static int do_fb_get_cmap(struct fb_cmap *cmap, struct fb_var_screeninfo *var,

                          int kspc);

static int do_fb_set_cmap(struct fb_cmap *cmap, struct fb_var_screeninfo *var,

                          int kspc);

static void do_install_cmap(int con);

static void memcpy_fs(int fsfromto, void *to, void *from, int len);

static void copy_cmap(struct fb_cmap *from, struct fb_cmap *to, int fsfromto);

static int alloc_cmap(struct fb_cmap *cmap, int len, int transp);

static void crt_fb_set_disp(int con);

static int get_video_mode(const char *name);

/* -------------------- Hardware specific routines -------------------------- */

   /*

    *    Initialization

    *

    *    Set the default video mode for this chipset. If a video mode was

    *    specified on the command line, it will override the default mode.

    */

static int crt_init(void)

{

   int i;

   unsigned long *pfb;

   if (crtfb_mode == -1)

        crtfb_mode = CRT_DEFMODE;

#ifndef FBMEM_BASE_ADD

   crtMem = (*memstart + 0x0ful) & ~(0x0ful);

   crtSize = CRT_WIDTH*CRT_HEIGHT;

   *memstart = crtMem + crtSize;

#else

   crtMem = FBMEM_BASE_ADD;

   crtSize = CRT_WIDTH*CRT_HEIGHT;

#endif

   REG32(CRT_FB_BASE_REG) = crtMem;

   for (i = 0, pfb = (unsigned long *)crtMem; i < crtSize; i += 4, pfb++)

      *pfb = 0x01010101;

   REG32(CRT_CTL_REG) = 0x01ul;

   return (0);

}

   /*

    *    This function should fill in the `fix' structure based on the

    *    values in the `par' structure.

    */

static int crt_encode_fix(struct fb_fix_screeninfo *fix,

                          struct crt_fb_par *par)

{

   int i;

   strcpy(fix->id, crt_fb_name);

   fix->smem_start = crtMem;

   fix->smem_len = crtSize;

   fix->type = FB_TYPE_PACKED_PIXELS;

   fix->type_aux = 0;

   fix->visual = FB_VISUAL_PSEUDOCOLOR;

   fix->xpanstep = 0;

   fix->ypanstep = 0;

   fix->ywrapstep = 0;

   fix->line_length = CRT_WIDTH;

   for (i = 0; i < arraysize(fix->reserved); i++)

      fix->reserved[i] = 0;

   return(0);

}

   /*

    *    Get the video params out of `var'. If a value doesn't fit, round

    *    it up, if it's too big, return -EINVAL.

    */

static int crt_decode_var(struct fb_var_screeninfo *var,

                          struct crt_fb_par *par)

{

   par->xres = CRT_WIDTH;

   par->yres = CRT_HEIGHT;

   par->bpp = 8;

   return(0);

}

   /*

    *    Fill the `var' structure based on the values in `par' and maybe

    *    other values read out of the hardware.

    */

static int crt_encode_var(struct fb_var_screeninfo *var,

                          struct crt_fb_par *par)

{

   int i;

   var->xres = par->xres;

   var->yres = par->yres;

   var->xres_virtual = par->xres;

//   var->yres_virtual = par->yres;

   var->yres_virtual = 512*1024;

   var->xoffset = 0;

   var->yoffset = 0;

   var->bits_per_pixel = par->bpp;

   var->grayscale = 0;

   var->red.offset = 0;

   var->red.length = 5;

   var->red.msb_right = 0;

   var->green.offset = 0;

   var->green.length = 6;

   var->green.msb_right = 0;

   var->blue.offset = 0;

   var->blue.length = 5;

   var->blue.msb_right = 0;

   var->transp.offset = 0;

   var->transp.length = 0;

   var->transp.msb_right = 0;

   var->nonstd = 0;

   var->activate = FB_ACTIVATE_NOW;

   var->height = -1;

   var->width = -1;

   var->accel = FB_ACCEL_NONE;

   var->vmode = FB_VMODE_NONINTERLACED;

   /* Dummy values */

   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;

   for (i = 0; i < arraysize(var->reserved); i++)

      var->reserved[i] = 0;

   return(0);

}

   /*

    *    Set a single color register. The values supplied are already

    *    rounded down to the hardware's capabilities (according to the

    *    entries in the var structure). Return != 0 for invalid regno.

    */

static int crt_setcolreg(u_int regno, u_int red, u_int green, u_int blue,

                         u_int transp)

{

   if (regno > 255)

     return (1);

   setpal(regno, red, green, blue);

   crt_colour_table [regno][0] = red & 0xff;

   crt_colour_table [regno][1] = green & 0xff;

   crt_colour_table [regno][2] = blue & 0xff;

   crt_colour_table [regno][3] = transp;

   return (0);

}

   /*

    *    Read a single color register and split it into

    *    colors/transparent. Return != 0 for invalid regno.

    */

static int crt_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,

                         u_int *transp)

{

   if (regno > 255)

     return (1);

   *red    = crt_colour_table [regno][0];

   *green  = crt_colour_table [regno][1];

   *blue   = crt_colour_table [regno][2];

   *transp = crt_colour_table [regno][3];

   return (0);

}

   /*

    *    (Un)Blank the screen

    */

void crt_blank(int blank)

{

#if 0

        if (blank)

                (*(volatile unsigned char*)0xFFFFFA27) &= ~128;

        else

                (*(volatile unsigned char*)0xFFFFFA27) |= 128;

#endif

}

/**************************************************************

 * We are waiting for "fifo" FIFO-slots empty

 */

void crt_WaitQueue (u_short fifo)

{

}

/**************************************************************

 * We are waiting for Hardware (Graphics Engine) not busy

 */

void crt_WaitBlit (void)

{

}

/**************************************************************

 * BitBLT - Through the Plane

 */

void crt_BitBLT (u_short curx, u_short cury, u_short destx, u_short desty,

                   u_short width, u_short height, u_short mode)

{

#if 0

u_short blitcmd = S3_BITBLT;

/* Set drawing direction */

/* -Y, X maj, -X (default) */

if (curx > destx)

  blitcmd |= 0x0020;  /* Drawing direction +X */

else

  {

  curx  += (width - 1);

  destx += (width - 1);

  }

if (cury > desty)

  blitcmd |= 0x0080;  /* Drawing direction +Y */

else

  {

  cury  += (height - 1);

  desty += (height - 1);

  }

crt_WaitQueue (0x8000);

*((u_short volatile *)(crtRegs + S3_PIXEL_CNTL)) = 0xa000;

*((u_short volatile *)(crtRegs + S3_FRGD_MIX)) = (0x0060 | mode);

*((u_short volatile *)(crtRegs + S3_CUR_X)) = curx;

*((u_short volatile *)(crtRegs + S3_CUR_Y)) = cury;

*((u_short volatile *)(crtRegs + S3_DESTX_DIASTP)) = destx;

*((u_short volatile *)(crtRegs + S3_DESTY_AXSTP)) = desty;

*((u_short volatile *)(crtRegs + S3_MIN_AXIS_PCNT)) = height - 1;

*((u_short volatile *)(crtRegs + S3_MAJ_AXIS_PCNT)) = width  - 1;

*((u_short volatile *)(crtRegs + S3_CMD)) = blitcmd;

#endif

}

/**************************************************************

 * Rectangle Fill Solid

 */

void crt_RectFill (u_short x, u_short y, u_short width, u_short height,

                     u_short mode, u_short color)

{

#if 0

u_short blitcmd = S3_FILLEDRECT;

crt_WaitQueue (0x8000);

*((u_short volatile *)(crtRegs + S3_PIXEL_CNTL)) = 0xa000;

*((u_short volatile *)(crtRegs + S3_FRGD_MIX)) = (0x0020 | mode);

*((u_short volatile *)(crtRegs + S3_MULT_MISC)) = 0xe000;

*((u_short volatile *)(crtRegs + S3_FRGD_COLOR)) = color;

*((u_short volatile *)(crtRegs + S3_CUR_X)) = x;

*((u_short volatile *)(crtRegs + S3_CUR_Y)) = y;

*((u_short volatile *)(crtRegs + S3_MIN_AXIS_PCNT)) = height - 1;

*((u_short volatile *)(crtRegs + S3_MAJ_AXIS_PCNT)) = width  - 1;

*((u_short volatile *)(crtRegs + S3_CMD)) = blitcmd;

#endif

}

/**************************************************************

 * Move cursor to x, y

 */

void crt_MoveCursor (u_short x, u_short y)

{

        (*(volatile unsigned short*)0xFFFFFA18) = (crtfbCursorMode << 14) | x;

        (*(volatile unsigned short*)0xFFFFFA1A) = y;

#if 0

*(crtRegs + S3_CRTC_ADR)  = 0x39;

*(crtRegs + S3_CRTC_DATA) = 0xa0;

*(crtRegs + S3_CRTC_ADR)  = S3_HWGC_ORGX_H;

*(crtRegs + S3_CRTC_DATA) = (char)((x & 0x0700) >> 8);

*(crtRegs + S3_CRTC_ADR)  = S3_HWGC_ORGX_L;

*(crtRegs + S3_CRTC_DATA) = (char)(x & 0x00ff);

*(crtRegs + S3_CRTC_ADR)  = S3_HWGC_ORGY_H;

*(crtRegs + S3_CRTC_DATA) = (char)((y & 0x0700) >> 8);

*(crtRegs + S3_CRTC_ADR)  = S3_HWGC_ORGY_L;

*(crtRegs + S3_CRTC_DATA) = (char)(y & 0x00ff);

#endif

}

/* -------------------- Interfaces to hardware functions -------------------- */

static struct fb_hwswitch crt_switch = {

   crt_init, crt_encode_fix, crt_decode_var, crt_encode_var,

   crt_getcolreg, crt_setcolreg, crt_blank

};

/* -------------------- Generic routines ------------------------------------ */

   /*

    *    Fill the hardware's `par' structure.

    */

static void crt_fb_get_par(struct crt_fb_par *par)

{

   if (current_par_valid)

      *par = current_par;

   else

      fbhw->decode_var(&crt_fb_predefined[crtfb_mode], par);

}

static void crt_fb_set_par(struct crt_fb_par *par)

{

   current_par = *par;

   current_par_valid = 1;

}

static int do_fb_set_var(struct fb_var_screeninfo *var, int isactive)

{

   int err, activate;

   struct crt_fb_par par;

   if ((err = fbhw->decode_var(var, &par)))

      return(err);

   activate = var->activate;

   if ((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW && isactive)

      crt_fb_set_par(&par);

   fbhw->encode_var(var, &par);

   var->activate = activate;