mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-23 09:19:51 +00:00
2297 lines
61 KiB
C
2297 lines
61 KiB
C
![]() |
/*
|
||
|
* linux/drivers/video/cyberfb.c -- CyberVision64 frame buffer device
|
||
|
* $Id: cyberfb.c,v 1.6 1998/09/11 04:54:58 abair Exp $
|
||
|
*
|
||
|
* Copyright (C) 1998 Alan Bair
|
||
|
*
|
||
|
* This file is based on two CyberVision64 frame buffer device drivers
|
||
|
*
|
||
|
* The second CyberVision64 frame buffer device (cvision.c cvision_core.c):
|
||
|
*
|
||
|
* Copyright (c) 1997 Antonio Santos
|
||
|
*
|
||
|
* Released as a patch to 2.1.35, but never included in the source tree.
|
||
|
* This is based on work from the NetBSD CyberVision64 frame buffer driver
|
||
|
* and support files (grf_cv.c, grf_cvreg.h, ite_cv.c):
|
||
|
* Permission to use the source of this driver was obtained from the
|
||
|
* author Michael Teske by Alan Bair.
|
||
|
*
|
||
|
* Copyright (c) 1995 Michael Teske
|
||
|
*
|
||
|
* The first CyberVision64 frame buffer device (cyberfb.c):
|
||
|
*
|
||
|
* Copyright (C) 1996 Martin Apel
|
||
|
* Geert Uytterhoeven
|
||
|
*
|
||
|
* Which is based on the Amiga frame buffer device (amifb.c):
|
||
|
*
|
||
|
* Copyright (C) 1995 Geert Uytterhoeven
|
||
|
*
|
||
|
*
|
||
|
* History:
|
||
|
* - 22 Dec 95: Original version by Martin Apel
|
||
|
* - 05 Jan 96: Geert: integration into the current source tree
|
||
|
* - 01 Aug 98: Alan: Merge in code from cvision.c and cvision_core.c
|
||
|
* $Log: cyberfb.c,v $
|
||
|
* Revision 1.6 1998/09/11 04:54:58 abair
|
||
|
* Update for 2.1.120 change in include file location.
|
||
|
* Clean up for public release.
|
||
|
*
|
||
|
* Revision 1.5 1998/09/03 04:27:13 abair
|
||
|
* Move cv64_load_video_mode to cyber_set_video so a new video mode is install
|
||
|
* with each change of the 'var' data.
|
||
|
*
|
||
|
* Revision 1.4 1998/09/01 00:31:17 abair
|
||
|
* Put in a set of default 8,16,24 bpp modes and map cyber8,16 to them.
|
||
|
* Update operations with 'par' to handle a more complete set of parameter
|
||
|
* values for encode/decode process.
|
||
|
*
|
||
|
* Revision 1.3 1998/08/31 21:31:33 abair
|
||
|
* Swap 800x490 for 640x480 video mode and more cleanup.
|
||
|
* Abandon idea to resurrect "custom" mode setting via kernel opts,
|
||
|
* instead work on making use of fbset program to do this.
|
||
|
*
|
||
|
* Revision 1.2 1998/08/31 06:17:08 abair
|
||
|
* Make updates for changes in cyberfb.c released in 2.1.119
|
||
|
* and do some cleanup of the code.
|
||
|
*
|
||
|
* Revision 1.1 1998/08/29 18:38:31 abair
|
||
|
* Initial revision
|
||
|
*
|
||
|
* Revision 1.3 1998/08/17 06:21:53 abair
|
||
|
* Remove more redundant code after merging in cvision_core.c
|
||
|
* Set blanking by colormap to pale red to detect this vs trying to
|
||
|
* use video blanking. More formating to Linux code style.
|
||
|
*
|
||
|
* Revision 1.2 1998/08/15 17:51:37 abair
|
||
|
* Added cvision_core.c code from 2.1.35 patches.
|
||
|
* Changed to compile correctly and switch to using initialization
|
||
|
* code. Added debugging and dropping of duplicate code.
|
||
|
*
|
||
|
*
|
||
|
*
|
||
|
* 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/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/errno.h>
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/mm.h>
|
||
|
#include <linux/tty.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/zorro.h>
|
||
|
#include <linux/fb.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <asm/uaccess.h>
|
||
|
#include <asm/system.h>
|
||
|
#include <asm/irq.h>
|
||
|
#include <asm/pgtable.h>
|
||
|
#include <asm/amigahw.h>
|
||
|
#include <asm/io.h>
|
||
|
|
||
|
#include "cyberfb.h"
|
||
|
#include <video/fbcon.h>
|
||
|
#include <video/fbcon-cfb8.h>
|
||
|
#include <video/fbcon-cfb16.h>
|
||
|
|
||
|
/*#define CYBERFBDEBUG*/
|
||
|
#ifdef CYBERFBDEBUG
|
||
|
#define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args)
|
||
|
static void cv64_dump(void);
|
||
|
#else
|
||
|
#define DPRINTK(fmt, args...)
|
||
|
#endif
|
||
|
|
||
|
#define wb_64(regs,reg,dat) (*(((volatile unsigned char *)regs) + reg) = dat)
|
||
|
#define rb_64(regs, reg) (*(((volatile unsigned char *)regs) + reg))
|
||
|
|
||
|
#define ww_64(regs,reg,dat) (*((volatile unsigned short *)(regs + reg) = dat)
|
||
|
|
||
|
struct cyberfb_par {
|
||
|
struct fb_var_screeninfo var;
|
||
|
__u32 type;
|
||
|
__u32 type_aux;
|
||
|
__u32 visual;
|
||
|
__u32 line_length;
|
||
|
};
|
||
|
|
||
|
static struct cyberfb_par current_par;
|
||
|
|
||
|
static int current_par_valid = 0;
|
||
|
|
||
|
static struct display disp;
|
||
|
static struct fb_info fb_info;
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Frame Buffer Name
|
||
|
*/
|
||
|
|
||
|
static char cyberfb_name[16] = "Cybervision";
|
||
|
|
||
|
|
||
|
/*
|
||
|
* CyberVision Graphics Board
|
||
|
*/
|
||
|
|
||
|
static unsigned char Cyber_colour_table [256][3];
|
||
|
static unsigned long CyberSize;
|
||
|
static volatile unsigned char *CyberBase;
|
||
|
static volatile unsigned char *CyberMem;
|
||
|
static volatile unsigned char *CyberRegs;
|
||
|
static unsigned long CyberMem_phys;
|
||
|
static unsigned long CyberRegs_phys;
|
||
|
|
||
|
/*
|
||
|
* Predefined Video Modes
|
||
|
*/
|
||
|
|
||
|
static struct {
|
||
|
const char *name;
|
||
|
struct fb_var_screeninfo var;
|
||
|
} cyberfb_predefined[] __initdata = {
|
||
|
{ "640x480-8", { /* Default 8 BPP mode (cyber8) */
|
||
|
640, 480, 640, 480, 0, 0, 8, 0,
|
||
|
{0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 39722, 40, 24, 32, 11, 96, 2,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
{ "640x480-16", { /* Default 16 BPP mode (cyber16) */
|
||
|
640, 480, 640, 480, 0, 0, 16, 0,
|
||
|
{11, 5, 0}, {5, 6, 0}, {0, 5, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 39722, 40, 24, 32, 11, 96, 2,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
{ "640x480-24", { /* Default 24 BPP mode */
|
||
|
640, 480, 640, 480, 0, 0, 24, 0,
|
||
|
{16, 8, 0}, {8, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 39722, 40, 24, 32, 11, 96, 2,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
{ "800x490-8", { /* Cybervision 8 bpp */
|
||
|
/* NO Acceleration */
|
||
|
800, 490, 800, 490, 0, 0, 8, 0,
|
||
|
{0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCEL_NONE, 33333, 80, 24, 23, 1, 56, 8,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
/* I can't test these with my monitor, but I suspect they will
|
||
|
* be OK, since Antonio Santos indicated he had tested them in
|
||
|
* his system.
|
||
|
*/
|
||
|
{ "800x600-8", { /* Cybervision 8 bpp */
|
||
|
800, 600, 800, 600, 0, 0, 8, 0,
|
||
|
{0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 27778, 64, 24, 22, 1, 72, 2,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
{ "1024x768-8", { /* Cybervision 8 bpp */
|
||
|
1024, 768, 1024, 768, 0, 0, 8, 0,
|
||
|
{0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 16667, 224, 72, 60, 12, 168, 4,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
{ "1152x886-8", { /* Cybervision 8 bpp */
|
||
|
1152, 886, 1152, 886, 0, 0, 8, 0,
|
||
|
{0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 15873, 184, 40, 24, 1, 56, 16,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_NONINTERLACED
|
||
|
}},
|
||
|
{ "1280x1024-8", { /* Cybervision 8 bpp */
|
||
|
1280, 1024, 1280, 1024, 0, 0, 8, 0,
|
||
|
{0, 8, 0}, {0, 8, 0}, {0, 8, 0}, {0, 0, 0},
|
||
|
0, 0, -1, -1, FB_ACCELF_TEXT, 16667, 256, 48, 50, 12, 72, 4,
|
||
|
FB_SYNC_COMP_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT,
|
||
|
FB_VMODE_INTERLACED
|
||
|
}}
|
||
|
};
|
||
|
|
||
|
#define NUM_TOTAL_MODES ARRAY_SIZE(cyberfb_predefined)
|
||
|
|
||
|
static int Cyberfb_inverse = 0;
|
||
|
|
||
|
/*
|
||
|
* Some default modes
|
||
|
*/
|
||
|
|
||
|
#define CYBER8_DEFMODE (0)
|
||
|
#define CYBER16_DEFMODE (1)
|
||
|
|
||
|
static struct fb_var_screeninfo cyberfb_default;
|
||
|
static int cyberfb_usermode __initdata = 0;
|
||
|
|
||
|
/*
|
||
|
* Interface used by the world
|
||
|
*/
|
||
|
|
||
|
int cyberfb_setup(char *options);
|
||
|
|
||
|
static int cyberfb_get_fix(struct fb_fix_screeninfo *fix, int con,
|
||
|
struct fb_info *info);
|
||
|
static int cyberfb_get_var(struct fb_var_screeninfo *var, int con,
|
||
|
struct fb_info *info);
|
||
|
static int cyberfb_set_var(struct fb_var_screeninfo *var, int con,
|
||
|
struct fb_info *info);
|
||
|
static int cyberfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
|
||
|
struct fb_info *info);
|
||
|
static int cyberfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
|
||
|
u_int transp, struct fb_info *info);
|
||
|
static int cyberfb_blank(int blank, struct fb_info *info);
|
||
|
|
||
|
/*
|
||
|
* Interface to the low level console driver
|
||
|
*/
|
||
|
|
||
|
int cyberfb_init(void);
|
||
|
static int Cyberfb_switch(int con, struct fb_info *info);
|
||
|
static int Cyberfb_updatevar(int con, struct fb_info *info);
|
||
|
|
||
|
/*
|
||
|
* Text console acceleration
|
||
|
*/
|
||
|
|
||
|
#ifdef FBCON_HAS_CFB8
|
||
|
static struct display_switch fbcon_cyber8;
|
||
|
#endif
|
||
|
|
||
|
/*
|
||
|
* Accelerated Functions used by the low level console driver
|
||
|
*/
|
||
|
|
||
|
static void Cyber_WaitQueue(u_short fifo);
|
||
|
static void Cyber_WaitBlit(void);
|
||
|
static void Cyber_BitBLT(u_short curx, u_short cury, u_short destx,
|
||
|
u_short desty, u_short width, u_short height,
|
||
|
u_short mode);
|
||
|
static void Cyber_RectFill(u_short x, u_short y, u_short width, u_short height,
|
||
|
u_short mode, u_short color);
|
||
|
#if 0
|
||
|
static void Cyber_MoveCursor(u_short x, u_short y);
|
||
|
#endif
|
||
|
|
||
|
/*
|
||
|
* Hardware Specific Routines
|
||
|
*/
|
||
|
|
||
|
static int Cyber_init(void);
|
||
|
static int Cyber_encode_fix(struct fb_fix_screeninfo *fix,
|
||
|
struct cyberfb_par *par);
|
||
|
static int Cyber_decode_var(struct fb_var_screeninfo *var,
|
||
|
struct cyberfb_par *par);
|
||
|
static int Cyber_encode_var(struct fb_var_screeninfo *var,
|
||
|
struct cyberfb_par *par);
|
||
|
static int Cyber_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,
|
||
|
u_int *transp, struct fb_info *info);
|
||
|
|
||
|
/*
|
||
|
* Internal routines
|
||
|
*/
|
||
|
|
||
|
static void cyberfb_get_par(struct cyberfb_par *par);
|
||
|
static void cyberfb_set_par(struct cyberfb_par *par);
|
||
|
static int do_fb_set_var(struct fb_var_screeninfo *var, int isactive);
|
||
|
static void cyberfb_set_disp(int con, struct fb_info *info);
|
||
|
static int get_video_mode(const char *name);
|
||
|
|
||
|
/* For cvision_core.c */
|
||
|
static unsigned short cv64_compute_clock(unsigned long);
|
||
|
static int cv_has_4mb (volatile unsigned char *);
|
||
|
static void cv64_board_init (void);
|
||
|
static void cv64_load_video_mode (struct fb_var_screeninfo *);
|
||
|
|
||
|
|
||
|
/* -------------------- 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 Cyber_init(void)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
volatile unsigned long *CursorBase;
|
||
|
int i;
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
/* Init local cmap as greyscale levels */
|
||
|
for (i = 0; i < 256; i++) {
|
||
|
Cyber_colour_table [i][0] = i;
|
||
|
Cyber_colour_table [i][1] = i;
|
||
|
Cyber_colour_table [i][2] = i;
|
||
|
}
|
||
|
|
||
|
/* Initialize the board and determine fbmem size */
|
||
|
cv64_board_init();
|
||
|
#ifdef CYBERFBDEBUG
|
||
|
DPRINTK("Register state after initing board\n");
|
||
|
cv64_dump();
|
||
|
#endif
|
||
|
/* Clear framebuffer memory */
|
||
|
DPRINTK("Clear framebuffer memory\n");
|
||
|
memset ((char *)CyberMem, 0, CyberSize);
|
||
|
|
||
|
/* Disable hardware cursor */
|
||
|
DPRINTK("Disable HW cursor\n");
|
||
|
wb_64(regs, S3_CRTC_ADR, S3_REG_LOCK2);
|
||
|
wb_64(regs, S3_CRTC_DATA, 0xa0);
|
||
|
wb_64(regs, S3_CRTC_ADR, S3_HGC_MODE);
|
||
|
wb_64(regs, S3_CRTC_DATA, 0x00);
|
||
|
wb_64(regs, S3_CRTC_ADR, S3_HWGC_DX);
|
||
|
wb_64(regs, S3_CRTC_DATA, 0x00);
|
||
|
wb_64(regs, S3_CRTC_ADR, S3_HWGC_DY);
|
||
|
wb_64(regs, S3_CRTC_DATA, 0x00);
|
||
|
|
||
|
/* Initialize hardware cursor */
|
||
|
DPRINTK("Init HW cursor\n");
|
||
|
CursorBase = (u_long *)((char *)(CyberMem) + CyberSize - 0x400);
|
||
|
for (i=0; i < 8; i++)
|
||
|
{
|
||
|
*(CursorBase +(i*4)) = 0xffffff00;
|
||
|
*(CursorBase+1+(i*4)) = 0xffff0000;
|
||
|
*(CursorBase+2+(i*4)) = 0xffff0000;
|
||
|
*(CursorBase+3+(i*4)) = 0xffff0000;
|
||
|
}
|
||
|
for (i=8; i < 64; i++)
|
||
|
{
|
||
|
*(CursorBase +(i*4)) = 0xffff0000;
|
||
|
*(CursorBase+1+(i*4)) = 0xffff0000;
|
||
|
*(CursorBase+2+(i*4)) = 0xffff0000;
|
||
|
*(CursorBase+3+(i*4)) = 0xffff0000;
|
||
|
}
|
||
|
|
||
|
cyberfb_setcolreg (255, 56<<8, 100<<8, 160<<8, 0, NULL /* unused */);
|
||
|
cyberfb_setcolreg (254, 0, 0, 0, 0, NULL /* unused */);
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* This function should fill in the `fix' structure based on the
|
||
|
* values in the `par' structure.
|
||
|
*/
|
||
|
|
||
|
static int Cyber_encode_fix(struct fb_fix_screeninfo *fix,
|
||
|
struct cyberfb_par *par)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
memset(fix, 0, sizeof(struct fb_fix_screeninfo));
|
||
|
strcpy(fix->id, cyberfb_name);
|
||
|
fix->smem_start = CyberMem_phys;
|
||
|
fix->smem_len = CyberSize;
|
||
|
fix->mmio_start = CyberRegs_phys;
|
||
|
fix->mmio_len = 0x10000;
|
||
|
|
||
|
fix->type = FB_TYPE_PACKED_PIXELS;
|
||
|
fix->type_aux = 0;
|
||
|
if (par->var.bits_per_pixel == 15 || par->var.bits_per_pixel == 16 ||
|
||
|
par->var.bits_per_pixel == 24 || par->var.bits_per_pixel == 32) {
|
||
|
fix->visual = FB_VISUAL_DIRECTCOLOR;
|
||
|
} else {
|
||
|
fix->visual = FB_VISUAL_PSEUDOCOLOR;
|
||
|
}
|
||
|
|
||
|
fix->xpanstep = 0;
|
||
|
fix->ypanstep = 0;
|
||
|
fix->ywrapstep = 0;
|
||
|
fix->line_length = 0;
|
||
|
fix->accel = FB_ACCEL_S3_TRIO64;
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Fill the `par' structure based on the values in `var'.
|
||
|
* TODO: Verify and adjust values, return -EINVAL if bad.
|
||
|
*/
|
||
|
|
||
|
static int Cyber_decode_var(struct fb_var_screeninfo *var,
|
||
|
struct cyberfb_par *par)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
par->var.xres = var->xres;
|
||
|
par->var.yres = var->yres;
|
||
|
par->var.xres_virtual = var->xres_virtual;
|
||
|
par->var.yres_virtual = var->yres_virtual;
|
||
|
par->var.xoffset = var->xoffset;
|
||
|
par->var.yoffset = var->yoffset;
|
||
|
par->var.bits_per_pixel = var->bits_per_pixel;
|
||
|
par->var.grayscale = var->grayscale;
|
||
|
par->var.red = var->red;
|
||
|
par->var.green = var->green;
|
||
|
par->var.blue = var->blue;
|
||
|
par->var.transp = var->transp;
|
||
|
par->var.nonstd = var->nonstd;
|
||
|
par->var.activate = var->activate;
|
||
|
par->var.height = var->height;
|
||
|
par->var.width = var->width;
|
||
|
if (var->accel_flags & FB_ACCELF_TEXT) {
|
||
|
par->var.accel_flags = FB_ACCELF_TEXT;
|
||
|
} else {
|
||
|
par->var.accel_flags = 0;
|
||
|
}
|
||
|
par->var.pixclock = var->pixclock;
|
||
|
par->var.left_margin = var->left_margin;
|
||
|
par->var.right_margin = var->right_margin;
|
||
|
par->var.upper_margin = var->upper_margin;
|
||
|
par->var.lower_margin = var->lower_margin;
|
||
|
par->var.hsync_len = var->hsync_len;
|
||
|
par->var.vsync_len = var->vsync_len;
|
||
|
par->var.sync = var->sync;
|
||
|
par->var.vmode = var->vmode;
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Fill the `var' structure based on the values in `par' and maybe
|
||
|
* other values read out of the hardware.
|
||
|
*/
|
||
|
|
||
|
static int Cyber_encode_var(struct fb_var_screeninfo *var,
|
||
|
struct cyberfb_par *par)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
var->xres = par->var.xres;
|
||
|
var->yres = par->var.yres;
|
||
|
var->xres_virtual = par->var.xres_virtual;
|
||
|
var->yres_virtual = par->var.yres_virtual;
|
||
|
var->xoffset = par->var.xoffset;
|
||
|
var->yoffset = par->var.yoffset;
|
||
|
|
||
|
var->bits_per_pixel = par->var.bits_per_pixel;
|
||
|
var->grayscale = par->var.grayscale;
|
||
|
|
||
|
var->red = par->var.red;
|
||
|
var->green = par->var.green;
|
||
|
var->blue = par->var.blue;
|
||
|
var->transp = par->var.transp;
|
||
|
|
||
|
var->nonstd = par->var.nonstd;
|
||
|
var->activate = par->var.activate;
|
||
|
|
||
|
var->height = par->var.height;
|
||
|
var->width = par->var.width;
|
||
|
|
||
|
var->accel_flags = par->var.accel_flags;
|
||
|
|
||
|
var->pixclock = par->var.pixclock;
|
||
|
var->left_margin = par->var.left_margin;
|
||
|
var->right_margin = par->var.right_margin;
|
||
|
var->upper_margin = par->var.upper_margin;
|
||
|
var->lower_margin = par->var.lower_margin;
|
||
|
var->hsync_len = par->var.hsync_len;
|
||
|
var->vsync_len = par->var.vsync_len;
|
||
|
var->sync = par->var.sync;
|
||
|
var->vmode = par->var.vmode;
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Set a single color register. Return != 0 for invalid regno.
|
||
|
*/
|
||
|
|
||
|
static int cyberfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
|
||
|
u_int transp, struct fb_info *info)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
|
||
|
/*DPRINTK("ENTER\n");*/
|
||
|
if (regno > 255) {
|
||
|
DPRINTK("EXIT - Register # > 255\n");
|
||
|
return (1);
|
||
|
}
|
||
|
|
||
|
wb_64(regs, 0x3c8, (unsigned char) regno);
|
||
|
|
||
|
red >>= 10;
|
||
|
green >>= 10;
|
||
|
blue >>= 10;
|
||
|
|
||
|
Cyber_colour_table [regno][0] = red;
|
||
|
Cyber_colour_table [regno][1] = green;
|
||
|
Cyber_colour_table [regno][2] = blue;
|
||
|
|
||
|
wb_64(regs, 0x3c9, red);
|
||
|
wb_64(regs, 0x3c9, green);
|
||
|
wb_64(regs, 0x3c9, blue);
|
||
|
|
||
|
/*DPRINTK("EXIT\n");*/
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Read a single color register and split it into
|
||
|
* colors/transparent. Return != 0 for invalid regno.
|
||
|
*/
|
||
|
|
||
|
static int Cyber_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,
|
||
|
u_int *transp, struct fb_info *info)
|
||
|
{
|
||
|
int t;
|
||
|
|
||
|
/*DPRINTK("ENTER\n");*/
|
||
|
if (regno > 255) {
|
||
|
DPRINTK("EXIT - Register # > 255\n");
|
||
|
return (1);
|
||
|
}
|
||
|
/* ARB This shifting & oring seems VERY strange */
|
||
|
t = Cyber_colour_table [regno][0];
|
||
|
*red = (t<<10) | (t<<4) | (t>>2);
|
||
|
t = Cyber_colour_table [regno][1];
|
||
|
*green = (t<<10) | (t<<4) | (t>>2);
|
||
|
t = Cyber_colour_table [regno][2];
|
||
|
*blue = (t<<10) | (t<<4) | (t>>2);
|
||
|
*transp = 0;
|
||
|
/*DPRINTK("EXIT\n");*/
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* (Un)Blank the screen
|
||
|
* blank: 1 = zero fb cmap
|
||
|
* 0 = restore fb cmap from local cmap
|
||
|
*/
|
||
|
static int cyberfb_blank(int blank, struct fb_info *info)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
int i;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
#if 0
|
||
|
/* Blank by turning gfx off */
|
||
|
gfx_on_off (1, regs);
|
||
|
#else
|
||
|
if (blank) {
|
||
|
for (i = 0; i < 256; i++) {
|
||
|
wb_64(regs, 0x3c8, (unsigned char) i);
|
||
|
/* ARB Pale red to detect this blanking method */
|
||
|
wb_64(regs, 0x3c9, 48);
|
||
|
wb_64(regs, 0x3c9, 0);
|
||
|
wb_64(regs, 0x3c9, 0);
|
||
|
}
|
||
|
} else {
|
||
|
for (i = 0; i < 256; i++) {
|
||
|
wb_64(regs, 0x3c8, (unsigned char) i);
|
||
|
wb_64(regs, 0x3c9, Cyber_colour_table[i][0]);
|
||
|
wb_64(regs, 0x3c9, Cyber_colour_table[i][1]);
|
||
|
wb_64(regs, 0x3c9, Cyber_colour_table[i][2]);
|
||
|
}
|
||
|
}
|
||
|
#endif
|
||
|
DPRINTK("EXIT\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
/**************************************************************
|
||
|
* We are waiting for "fifo" FIFO-slots empty
|
||
|
*/
|
||
|
static void Cyber_WaitQueue (u_short fifo)
|
||
|
{
|
||
|
unsigned short status;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
do {
|
||
|
status = *((u_short volatile *)(CyberRegs + S3_GP_STAT));
|
||
|
} while (status & fifo);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
/**************************************************************
|
||
|
* We are waiting for Hardware (Graphics Engine) not busy
|
||
|
*/
|
||
|
static void Cyber_WaitBlit (void)
|
||
|
{
|
||
|
unsigned short status;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
do {
|
||
|
status = *((u_short volatile *)(CyberRegs + S3_GP_STAT));
|
||
|
} while (status & S3_HDW_BUSY);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
/**************************************************************
|
||
|
* BitBLT - Through the Plane
|
||
|
*/
|
||
|
static void Cyber_BitBLT (u_short curx, u_short cury, u_short destx,
|
||
|
u_short desty, u_short width, u_short height,
|
||
|
u_short mode)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
u_short blitcmd = S3_BITBLT;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
/* 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);
|
||
|
}
|
||
|
|
||
|
Cyber_WaitQueue (0x8000);
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_PIXEL_CNTL)) = 0xa000;
|
||
|
*((u_short volatile *)(regs + S3_FRGD_MIX)) = (0x0060 | mode);
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_CUR_X)) = curx;
|
||
|
*((u_short volatile *)(regs + S3_CUR_Y)) = cury;
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_DESTX_DIASTP)) = destx;
|
||
|
*((u_short volatile *)(regs + S3_DESTY_AXSTP)) = desty;
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_MIN_AXIS_PCNT)) = height - 1;
|
||
|
*((u_short volatile *)(regs + S3_MAJ_AXIS_PCNT)) = width - 1;
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_CMD)) = blitcmd;
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
/**************************************************************
|
||
|
* Rectangle Fill Solid
|
||
|
*/
|
||
|
static void Cyber_RectFill (u_short x, u_short y, u_short width,
|
||
|
u_short height, u_short mode, u_short color)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
u_short blitcmd = S3_FILLEDRECT;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
Cyber_WaitQueue (0x8000);
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_PIXEL_CNTL)) = 0xa000;
|
||
|
*((u_short volatile *)(regs + S3_FRGD_MIX)) = (0x0020 | mode);
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_MULT_MISC)) = 0xe000;
|
||
|
*((u_short volatile *)(regs + S3_FRGD_COLOR)) = color;
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_CUR_X)) = x;
|
||
|
*((u_short volatile *)(regs + S3_CUR_Y)) = y;
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_MIN_AXIS_PCNT)) = height - 1;
|
||
|
*((u_short volatile *)(regs + S3_MAJ_AXIS_PCNT)) = width - 1;
|
||
|
|
||
|
*((u_short volatile *)(regs + S3_CMD)) = blitcmd;
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
|
||
|
#if 0
|
||
|
/**************************************************************
|
||
|
* Move cursor to x, y
|
||
|
*/
|
||
|
static void Cyber_MoveCursor (u_short x, u_short y)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
DPRINTK("ENTER\n");
|
||
|
*(regs + S3_CRTC_ADR) = 0x39;
|
||
|
*(regs + S3_CRTC_DATA) = 0xa0;
|
||
|
|
||
|
*(regs + S3_CRTC_ADR) = S3_HWGC_ORGX_H;
|
||
|
*(regs + S3_CRTC_DATA) = (char)((x & 0x0700) >> 8);
|
||
|
*(regs + S3_CRTC_ADR) = S3_HWGC_ORGX_L;
|
||
|
*(regs + S3_CRTC_DATA) = (char)(x & 0x00ff);
|
||
|
|
||
|
*(regs + S3_CRTC_ADR) = S3_HWGC_ORGY_H;
|
||
|
*(regs + S3_CRTC_DATA) = (char)((y & 0x0700) >> 8);
|
||
|
*(regs + S3_CRTC_ADR) = S3_HWGC_ORGY_L;
|
||
|
*(regs + S3_CRTC_DATA) = (char)(y & 0x00ff);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
|
||
|
/* -------------------- Generic routines ---------------------------------- */
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Fill the hardware's `par' structure.
|
||
|
*/
|
||
|
|
||
|
static void cyberfb_get_par(struct cyberfb_par *par)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (current_par_valid) {
|
||
|
*par = current_par;
|
||
|
} else {
|
||
|
Cyber_decode_var(&cyberfb_default, par);
|
||
|
}
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
|
||
|
static void cyberfb_set_par(struct cyberfb_par *par)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
current_par = *par;
|
||
|
current_par_valid = 1;
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
|
||
|
static void cyber_set_video(struct fb_var_screeninfo *var)
|
||
|
{
|
||
|
|
||
|
/* Load the video mode defined by the 'var' data */
|
||
|
cv64_load_video_mode (var);
|
||
|
#ifdef CYBERFBDEBUG
|
||
|
DPRINTK("Register state after loading video mode\n");
|
||
|
cv64_dump();
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
|
||
|
static int do_fb_set_var(struct fb_var_screeninfo *var, int isactive)
|
||
|
{
|
||
|
int err, activate;
|
||
|
struct cyberfb_par par;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if ((err = Cyber_decode_var(var, &par))) {
|
||
|
DPRINTK("EXIT - decode_var failed\n");
|
||
|
return(err);
|
||
|
}
|
||
|
activate = var->activate;
|
||
|
if ((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW && isactive)
|
||
|
cyberfb_set_par(&par);
|
||
|
Cyber_encode_var(var, &par);
|
||
|
var->activate = activate;
|
||
|
|
||
|
cyber_set_video(var);
|
||
|
DPRINTK("EXIT\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Get the Fixed Part of the Display
|
||
|
*/
|
||
|
|
||
|
static int cyberfb_get_fix(struct fb_fix_screeninfo *fix, int con,
|
||
|
struct fb_info *info)
|
||
|
{
|
||
|
struct cyberfb_par par;
|
||
|
int error = 0;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (con == -1) {
|
||
|
cyberfb_get_par(&par);
|
||
|
} else {
|
||
|
error = Cyber_decode_var(&fb_display[con].var, &par);
|
||
|
}
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(error ? error : Cyber_encode_fix(fix, &par));
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Get the User Defined Part of the Display
|
||
|
*/
|
||
|
|
||
|
static int cyberfb_get_var(struct fb_var_screeninfo *var, int con,
|
||
|
struct fb_info *info)
|
||
|
{
|
||
|
struct cyberfb_par par;
|
||
|
int error = 0;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (con == -1) {
|
||
|
cyberfb_get_par(&par);
|
||
|
error = Cyber_encode_var(var, &par);
|
||
|
disp.var = *var; /* ++Andre: don't know if this is the right place */
|
||
|
} else {
|
||
|
*var = fb_display[con].var;
|
||
|
}
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(error);
|
||
|
}
|
||
|
|
||
|
|
||
|
static void cyberfb_set_disp(int con, struct fb_info *info)
|
||
|
{
|
||
|
struct fb_fix_screeninfo fix;
|
||
|
struct display *display;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (con >= 0)
|
||
|
display = &fb_display[con];
|
||
|
else
|
||
|
display = &disp; /* used during initialization */
|
||
|
|
||
|
cyberfb_get_fix(&fix, con, info);
|
||
|
if (con == -1)
|
||
|
con = 0;
|
||
|
display->visual = fix.visual;
|
||
|
display->type = fix.type;
|
||
|
display->type_aux = fix.type_aux;
|
||
|
display->ypanstep = fix.ypanstep;
|
||
|
display->ywrapstep = fix.ywrapstep;
|
||
|
display->can_soft_blank = 1;
|
||
|
display->inverse = Cyberfb_inverse;
|
||
|
switch (display->var.bits_per_pixel) {
|
||
|
#ifdef FBCON_HAS_CFB8
|
||
|
case 8:
|
||
|
if (display->var.accel_flags & FB_ACCELF_TEXT) {
|
||
|
display->dispsw = &fbcon_cyber8;
|
||
|
#warning FIXME: We should reinit the graphics engine here
|
||
|
} else
|
||
|
display->dispsw = &fbcon_cfb8;
|
||
|
break;
|
||
|
#endif
|
||
|
#ifdef FBCON_HAS_CFB16
|
||
|
case 16:
|
||
|
display->dispsw = &fbcon_cfb16;
|
||
|
break;
|
||
|
#endif
|
||
|
default:
|
||
|
display->dispsw = NULL;
|
||
|
break;
|
||
|
}
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Set the User Defined Part of the Display
|
||
|
*/
|
||
|
|
||
|
static int cyberfb_set_var(struct fb_var_screeninfo *var, int con,
|
||
|
struct fb_info *info)
|
||
|
{
|
||
|
int err, oldxres, oldyres, oldvxres, oldvyres, oldbpp, oldaccel;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if ((err = do_fb_set_var(var, con == info->currcon))) {
|
||
|
DPRINTK("EXIT - do_fb_set_var failed\n");
|
||
|
return(err);
|
||
|
}
|
||
|
if ((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
|
||
|
oldxres = fb_display[con].var.xres;
|
||
|
oldyres = fb_display[con].var.yres;
|
||
|
oldvxres = fb_display[con].var.xres_virtual;
|
||
|
oldvyres = fb_display[con].var.yres_virtual;
|
||
|
oldbpp = fb_display[con].var.bits_per_pixel;
|
||
|
oldaccel = fb_display[con].var.accel_flags;
|
||
|
fb_display[con].var = *var;
|
||
|
if (oldxres != var->xres || oldyres != var->yres ||
|
||
|
oldvxres != var->xres_virtual ||
|
||
|
oldvyres != var->yres_virtual ||
|
||
|
oldbpp != var->bits_per_pixel ||
|
||
|
oldaccel != var->accel_flags) {
|
||
|
cyberfb_set_disp(con, info);
|
||
|
(*fb_info.changevar)(con);
|
||
|
fb_alloc_cmap(&fb_display[con].cmap, 0, 0);
|
||
|
do_install_cmap(con, info);
|
||
|
}
|
||
|
}
|
||
|
var->activate = 0;
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Get the Colormap
|
||
|
*/
|
||
|
|
||
|
static int cyberfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
|
||
|
struct fb_info *info)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (con == info->currcon) { /* current console? */
|
||
|
DPRINTK("EXIT - console is current console\n");
|
||
|
return(fb_get_cmap(cmap, kspc, Cyber_getcolreg, info));
|
||
|
} else if (fb_display[con].cmap.len) { /* non default colormap? */
|
||
|
DPRINTK("Use console cmap\n");
|
||
|
fb_copy_cmap(&fb_display[con].cmap, cmap, kspc ? 0 : 2);
|
||
|
} else {
|
||
|
DPRINTK("Use default cmap\n");
|
||
|
fb_copy_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel),
|
||
|
cmap, kspc ? 0 : 2);
|
||
|
}
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
static struct fb_ops cyberfb_ops = {
|
||
|
.owner = THIS_MODULE,
|
||
|
.fb_get_fix = cyberfb_get_fix,
|
||
|
.fb_get_var = cyberfb_get_var,
|
||
|
.fb_set_var = cyberfb_set_var,
|
||
|
.fb_get_cmap = cyberfb_get_cmap,
|
||
|
.fb_set_cmap = gen_set_cmap,
|
||
|
.fb_setcolreg = cyberfb_setcolreg,
|
||
|
.fb_blank = cyberfb_blank,
|
||
|
};
|
||
|
|
||
|
int __init cyberfb_setup(char *options)
|
||
|
{
|
||
|
char *this_opt;
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
fb_info.fontname[0] = '\0';
|
||
|
|
||
|
if (!options || !*options) {
|
||
|
DPRINTK("EXIT - no options\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
while ((this_opt = strsep(&options, ",")) != NULL) {
|
||
|
if (!*this_opt)
|
||
|
continue;
|
||
|
if (!strcmp(this_opt, "inverse")) {
|
||
|
Cyberfb_inverse = 1;
|
||
|
fb_invert_cmaps();
|
||
|
} else if (!strncmp(this_opt, "font:", 5)) {
|
||
|
strcpy(fb_info.fontname, this_opt+5);
|
||
|
} else if (!strcmp (this_opt, "cyber8")) {
|
||
|
cyberfb_default = cyberfb_predefined[CYBER8_DEFMODE].var;
|
||
|
cyberfb_usermode = 1;
|
||
|
} else if (!strcmp (this_opt, "cyber16")) {
|
||
|
cyberfb_default = cyberfb_predefined[CYBER16_DEFMODE].var;
|
||
|
cyberfb_usermode = 1;
|
||
|
} else get_video_mode(this_opt);
|
||
|
}
|
||
|
|
||
|
DPRINTK("default mode: xres=%d, yres=%d, bpp=%d\n",
|
||
|
cyberfb_default.xres,
|
||
|
cyberfb_default.yres,
|
||
|
cyberfb_default.bits_per_pixel);
|
||
|
DPRINTK("EXIT\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Initialization
|
||
|
*/
|
||
|
|
||
|
int __init cyberfb_init(void)
|
||
|
{
|
||
|
unsigned long board_addr, board_size;
|
||
|
struct cyberfb_par par;
|
||
|
struct zorro_dev *z = NULL;
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
while ((z = zorro_find_device(ZORRO_PROD_PHASE5_CYBERVISION64, z))) {
|
||
|
board_addr = z->resource.start;
|
||
|
board_size = z->resource.end-z->resource.start+1;
|
||
|
CyberMem_phys = board_addr + 0x01400000;
|
||
|
CyberRegs_phys = CyberMem_phys + 0x00c00000;
|
||
|
if (!request_mem_region(CyberRegs_phys, 0x10000, "S3 Trio64"))
|
||
|
continue;
|
||
|
if (!request_mem_region(CyberMem_phys, 0x400000, "RAM")) {
|
||
|
release_mem_region(CyberRegs_phys, 0x10000);
|
||
|
continue;
|
||
|
}
|
||
|
DPRINTK("board_addr=%08lx\n", board_addr);
|
||
|
DPRINTK("board_size=%08lx\n", board_size);
|
||
|
|
||
|
CyberBase = ioremap(board_addr, board_size);
|
||
|
CyberRegs = CyberBase + 0x02000000;
|
||
|
CyberMem = CyberBase + 0x01400000;
|
||
|
DPRINTK("CyberBase=%08lx CyberRegs=%08lx CyberMem=%08lx\n",
|
||
|
CyberBase, (long unsigned int)CyberRegs, CyberMem);
|
||
|
|
||
|
#ifdef CYBERFBDEBUG
|
||
|
DPRINTK("Register state just after mapping memory\n");
|
||
|
cv64_dump();
|
||
|
#endif
|
||
|
|
||
|
strcpy(fb_info.modename, cyberfb_name);
|
||
|
fb_info.changevar = NULL;
|
||
|
fb_info.fbops = &cyberfb_ops;
|
||
|
fb_info.screen_base = (unsigned char *)CyberMem;
|
||
|
fb_info.disp = &disp;
|
||
|
fb_info.currcon = -1;
|
||
|
fb_info.switch_con = &Cyberfb_switch;
|
||
|
fb_info.updatevar = &Cyberfb_updatevar;
|
||
|
|
||
|
Cyber_init();
|
||
|
/* ++Andre: set cyberfb default mode */
|
||
|
if (!cyberfb_usermode) {
|
||
|
cyberfb_default = cyberfb_predefined[CYBER8_DEFMODE].var;
|
||
|
DPRINTK("Use default cyber8 mode\n");
|
||
|
}
|
||
|
Cyber_decode_var(&cyberfb_default, &par);
|
||
|
Cyber_encode_var(&cyberfb_default, &par);
|
||
|
|
||
|
do_fb_set_var(&cyberfb_default, 1);
|
||
|
cyberfb_get_var(&fb_display[0].var, -1, &fb_info);
|
||
|
cyberfb_set_disp(-1, &fb_info);
|
||
|
do_install_cmap(0, &fb_info);
|
||
|
|
||
|
if (register_framebuffer(&fb_info) < 0) {
|
||
|
DPRINTK("EXIT - register_framebuffer failed\n");
|
||
|
release_mem_region(CyberMem_phys, 0x400000);
|
||
|
release_mem_region(CyberRegs_phys, 0x10000);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
printk("fb%d: %s frame buffer device, using %ldK of video memory\n",
|
||
|
fb_info.node, fb_info.modename, CyberSize>>10);
|
||
|
|
||
|
/* TODO: This driver cannot be unloaded yet */
|
||
|
DPRINTK("EXIT\n");
|
||
|
return 0;
|
||
|
}
|
||
|
return -ENXIO;
|
||
|
}
|
||
|
|
||
|
|
||
|
static int Cyberfb_switch(int con, struct fb_info *info)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
/* Do we have to save the colormap? */
|
||
|
if (fb_display[info->currcon].cmap.len) {
|
||
|
fb_get_cmap(&fb_display[info->currcon].cmap, 1, Cyber_getcolreg,
|
||
|
info);
|
||
|
}
|
||
|
|
||
|
do_fb_set_var(&fb_display[con].var, 1);
|
||
|
info->currcon = con;
|
||
|
/* Install new colormap */
|
||
|
do_install_cmap(con, info);
|
||
|
DPRINTK("EXIT\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Update the `var' structure (called by fbcon.c)
|
||
|
*
|
||
|
* This call looks only at yoffset and the FB_VMODE_YWRAP flag in `var'.
|
||
|
* Since it's called by a kernel driver, no range checking is done.
|
||
|
*/
|
||
|
|
||
|
static int Cyberfb_updatevar(int con, struct fb_info *info)
|
||
|
{
|
||
|
DPRINTK("Enter - Exit\n");
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Get a Video Mode
|
||
|
*/
|
||
|
|
||
|
static int __init get_video_mode(const char *name)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
for (i = 0; i < NUM_TOTAL_MODES; i++) {
|
||
|
if (!strcmp(name, cyberfb_predefined[i].name)) {
|
||
|
cyberfb_default = cyberfb_predefined[i].var;
|
||
|
cyberfb_usermode = 1;
|
||
|
DPRINTK("EXIT - Matched predefined mode\n");
|
||
|
return(i);
|
||
|
}
|
||
|
}
|
||
|
return(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Text console acceleration
|
||
|
*/
|
||
|
|
||
|
#ifdef FBCON_HAS_CFB8
|
||
|
static void fbcon_cyber8_bmove(struct display *p, int sy, int sx, int dy,
|
||
|
int dx, int height, int width)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
sx *= 8; dx *= 8; width *= 8;
|
||
|
Cyber_BitBLT((u_short)sx, (u_short)(sy*fontheight(p)), (u_short)dx,
|
||
|
(u_short)(dy*fontheight(p)), (u_short)width,
|
||
|
(u_short)(height*fontheight(p)), (u_short)S3_NEW);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
static void fbcon_cyber8_clear(struct vc_data *conp, struct display *p, int sy,
|
||
|
int sx, int height, int width)
|
||
|
{
|
||
|
unsigned char bg;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
sx *= 8; width *= 8;
|
||
|
bg = attr_bgcol_ec(p,conp);
|
||
|
Cyber_RectFill((u_short)sx,
|
||
|
(u_short)(sy*fontheight(p)),
|
||
|
(u_short)width,
|
||
|
(u_short)(height*fontheight(p)),
|
||
|
(u_short)S3_NEW,
|
||
|
(u_short)bg);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
static void fbcon_cyber8_putc(struct vc_data *conp, struct display *p, int c,
|
||
|
int yy, int xx)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
Cyber_WaitBlit();
|
||
|
fbcon_cfb8_putc(conp, p, c, yy, xx);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
static void fbcon_cyber8_putcs(struct vc_data *conp, struct display *p,
|
||
|
const unsigned short *s, int count,
|
||
|
int yy, int xx)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
Cyber_WaitBlit();
|
||
|
fbcon_cfb8_putcs(conp, p, s, count, yy, xx);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
static void fbcon_cyber8_revc(struct display *p, int xx, int yy)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
Cyber_WaitBlit();
|
||
|
fbcon_cfb8_revc(p, xx, yy);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
static struct display_switch fbcon_cyber8 = {
|
||
|
.setup = fbcon_cfb8_setup,
|
||
|
.bmove = fbcon_cyber8_bmove,
|
||
|
.clear = fbcon_cyber8_clear,
|
||
|
.putc = fbcon_cyber8_putc,
|
||
|
.putcs = fbcon_cyber8_putcs,
|
||
|
.revc = fbcon_cyber8_revc,
|
||
|
.clear_margins =fbcon_cfb8_clear_margins,
|
||
|
.fontwidthmask =FONTWIDTH(8)
|
||
|
};
|
||
|
#endif
|
||
|
|
||
|
|
||
|
#ifdef MODULE
|
||
|
MODULE_LICENSE("GPL");
|
||
|
|
||
|
int init_module(void)
|
||
|
{
|
||
|
return cyberfb_init();
|
||
|
}
|
||
|
#endif /* MODULE */
|
||
|
|
||
|
/*
|
||
|
*
|
||
|
* Low level initialization routines for the CyberVision64 graphics card
|
||
|
*
|
||
|
* Most of the following code is from cvision_core.c
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
#define MAXPIXELCLOCK 135000000 /* safety */
|
||
|
|
||
|
#ifdef CV_AGGRESSIVE_TIMING
|
||
|
long cv64_memclk = 55000000;
|
||
|
#else
|
||
|
long cv64_memclk = 50000000;
|
||
|
#endif
|
||
|
|
||
|
/*********************/
|
||
|
|
||
|
static unsigned char clocks[]={
|
||
|
0x13, 0x61, 0x6b, 0x6d, 0x51, 0x69, 0x54, 0x69,
|
||
|
0x4f, 0x68, 0x6b, 0x6b, 0x18, 0x61, 0x7b, 0x6c,
|
||
|
0x51, 0x67, 0x24, 0x62, 0x56, 0x67, 0x77, 0x6a,
|
||
|
0x1d, 0x61, 0x53, 0x66, 0x6b, 0x68, 0x79, 0x69,
|
||
|
0x7c, 0x69, 0x7f, 0x69, 0x22, 0x61, 0x54, 0x65,
|
||
|
0x56, 0x65, 0x58, 0x65, 0x67, 0x66, 0x41, 0x63,
|
||
|
0x27, 0x61, 0x13, 0x41, 0x37, 0x62, 0x6b, 0x4d,
|
||
|
0x23, 0x43, 0x51, 0x49, 0x79, 0x66, 0x54, 0x49,
|
||
|
0x7d, 0x66, 0x34, 0x56, 0x4f, 0x63, 0x1f, 0x42,
|
||
|
0x6b, 0x4b, 0x7e, 0x4d, 0x18, 0x41, 0x2a, 0x43,
|
||
|
0x7b, 0x4c, 0x74, 0x4b, 0x51, 0x47, 0x65, 0x49,
|
||
|
0x24, 0x42, 0x68, 0x49, 0x56, 0x47, 0x75, 0x4a,
|
||
|
0x77, 0x4a, 0x31, 0x43, 0x1d, 0x41, 0x71, 0x49,
|
||
|
0x53, 0x46, 0x29, 0x42, 0x6b, 0x48, 0x1f, 0x41,
|
||
|
0x79, 0x49, 0x6f, 0x48, 0x7c, 0x49, 0x38, 0x43,
|
||
|
0x7f, 0x49, 0x5d, 0x46, 0x22, 0x41, 0x53, 0x45,
|
||
|
0x54, 0x45, 0x55, 0x45, 0x56, 0x45, 0x57, 0x45,
|
||
|
0x58, 0x45, 0x25, 0x41, 0x67, 0x46, 0x5b, 0x45,
|
||
|
0x41, 0x43, 0x78, 0x47, 0x27, 0x41, 0x51, 0x44,
|
||
|
0x13, 0x21, 0x7d, 0x47, 0x37, 0x42, 0x71, 0x46,
|
||
|
0x6b, 0x2d, 0x14, 0x21, 0x23, 0x23, 0x7d, 0x2f,
|
||
|
0x51, 0x29, 0x61, 0x2b, 0x79, 0x46, 0x1d, 0x22,
|
||
|
0x54, 0x29, 0x45, 0x27, 0x7d, 0x46, 0x7f, 0x46,
|
||
|
0x4f, 0x43, 0x2f, 0x41, 0x1f, 0x22, 0x6a, 0x2b,
|
||
|
0x6b, 0x2b, 0x5b, 0x29, 0x7e, 0x2d, 0x65, 0x44,
|
||
|
0x18, 0x21, 0x5e, 0x29, 0x2a, 0x23, 0x45, 0x26,
|
||
|
0x7b, 0x2c, 0x19, 0x21, 0x74, 0x2b, 0x75, 0x2b,
|
||
|
0x51, 0x27, 0x3f, 0x25, 0x65, 0x29, 0x40, 0x25,
|
||
|
0x24, 0x22, 0x41, 0x25, 0x68, 0x29, 0x42, 0x25,
|
||
|
0x56, 0x27, 0x7e, 0x2b, 0x75, 0x2a, 0x1c, 0x21,
|
||
|
0x77, 0x2a, 0x4f, 0x26, 0x31, 0x23, 0x6f, 0x29,
|
||
|
0x1d, 0x21, 0x32, 0x23, 0x71, 0x29, 0x72, 0x29,
|
||
|
0x53, 0x26, 0x69, 0x28, 0x29, 0x22, 0x75, 0x29,
|
||
|
0x6b, 0x28, 0x1f, 0x21, 0x1f, 0x21, 0x6d, 0x28,
|
||
|
0x79, 0x29, 0x2b, 0x22, 0x6f, 0x28, 0x59, 0x26,
|
||
|
0x7c, 0x29, 0x7d, 0x29, 0x38, 0x23, 0x21, 0x21,
|
||
|
0x7f, 0x29, 0x39, 0x23, 0x5d, 0x26, 0x75, 0x28,
|
||
|
0x22, 0x21, 0x77, 0x28, 0x53, 0x25, 0x6c, 0x27,
|
||
|
0x54, 0x25, 0x61, 0x26, 0x55, 0x25, 0x30, 0x22,
|
||
|
0x56, 0x25, 0x63, 0x26, 0x57, 0x25, 0x71, 0x27,
|
||
|
0x58, 0x25, 0x7f, 0x28, 0x25, 0x21, 0x74, 0x27,
|
||
|
0x67, 0x26, 0x40, 0x23, 0x5b, 0x25, 0x26, 0x21,
|
||
|
0x41, 0x23, 0x34, 0x22, 0x78, 0x27, 0x6b, 0x26,
|
||
|
0x27, 0x21, 0x35, 0x22, 0x51, 0x24, 0x7b, 0x27,
|
||
|
0x13, 0x1, 0x13, 0x1, 0x7d, 0x27, 0x4c, 0x9,
|
||
|
0x37, 0x22, 0x5b, 0xb, 0x71, 0x26, 0x5c, 0xb,
|
||
|
0x6b, 0xd, 0x47, 0x23, 0x14, 0x1, 0x4f, 0x9,
|
||
|
0x23, 0x3, 0x75, 0x26, 0x7d, 0xf, 0x1c, 0x2,
|
||
|
0x51, 0x9, 0x59, 0x24, 0x61, 0xb, 0x69, 0x25,
|
||
|
0x79, 0x26, 0x34, 0x5, 0x1d, 0x2, 0x6b, 0x25,
|
||
|
0x54, 0x9, 0x35, 0x5, 0x45, 0x7, 0x6d, 0x25,
|
||
|
0x7d, 0x26, 0x16, 0x1, 0x7f, 0x26, 0x77, 0xd,
|
||
|
0x4f, 0x23, 0x78, 0xd, 0x2f, 0x21, 0x27, 0x3,
|
||
|
0x1f, 0x2, 0x59, 0x9, 0x6a, 0xb, 0x73, 0x25,
|
||
|
0x6b, 0xb, 0x63, 0x24, 0x5b, 0x9, 0x20, 0x2,
|
||
|
0x7e, 0xd, 0x4b, 0x7, 0x65, 0x24, 0x43, 0x22,
|
||
|
0x18, 0x1, 0x6f, 0xb, 0x5e, 0x9, 0x70, 0xb,
|
||
|
0x2a, 0x3, 0x33, 0x4, 0x45, 0x6, 0x60, 0x9,
|
||
|
0x7b, 0xc, 0x19, 0x1, 0x19, 0x1, 0x7d, 0xc,
|
||
|
0x74, 0xb, 0x50, 0x7, 0x75, 0xb, 0x63, 0x9,
|
||
|
0x51, 0x7, 0x23, 0x2, 0x3f, 0x5, 0x1a, 0x1,
|
||
|
0x65, 0x9, 0x2d, 0x3, 0x40, 0x5, 0x0, 0x0,
|
||
|
};
|
||
|
|
||
|
/* Console colors */
|
||
|
unsigned char cvconscolors[16][3] = { /* background, foreground, hilite */
|
||
|
/* R G B */
|
||
|
{0x30, 0x30, 0x30},
|
||
|
{0x00, 0x00, 0x00},
|
||
|
{0x80, 0x00, 0x00},
|
||
|
{0x00, 0x80, 0x00},
|
||
|
{0x00, 0x00, 0x80},
|
||
|
{0x80, 0x80, 0x00},
|
||
|
{0x00, 0x80, 0x80},
|
||
|
{0x80, 0x00, 0x80},
|
||
|
{0xff, 0xff, 0xff},
|
||
|
{0x40, 0x40, 0x40},
|
||
|
{0xff, 0x00, 0x00},
|
||
|
{0x00, 0xff, 0x00},
|
||
|
{0x00, 0x00, 0xff},
|
||
|
{0xff, 0xff, 0x00},
|
||
|
{0x00, 0xff, 0xff},
|
||
|
{0x00, 0x00, 0xff}
|
||
|
};
|
||
|
|
||
|
/* -------------------- Hardware specific routines ------------------------- */
|
||
|
|
||
|
/* Read Attribute Controller Register=idx */
|
||
|
inline unsigned char RAttr (volatile unsigned char *regs, short idx)
|
||
|
{
|
||
|
wb_64 (regs, ACT_ADDRESS_W, idx);
|
||
|
mb();
|
||
|
udelay(100);
|
||
|
return (rb_64(regs, ACT_ADDRESS_R));
|
||
|
}
|
||
|
|
||
|
/* Read Sequencer Register=idx */
|
||
|
inline unsigned char RSeq (volatile unsigned char *regs, short idx)
|
||
|
{
|
||
|
wb_64 (regs, SEQ_ADDRESS, idx);
|
||
|
mb();
|
||
|
return (rb_64(regs, SEQ_ADDRESS_R));
|
||
|
}
|
||
|
|
||
|
/* Read CRT Controller Register=idx */
|
||
|
inline unsigned char RCrt (volatile unsigned char *regs, short idx)
|
||
|
{
|
||
|
wb_64 (regs, CRT_ADDRESS, idx);
|
||
|
mb();
|
||
|
return (rb_64(regs, CRT_ADDRESS_R));
|
||
|
}
|
||
|
|
||
|
/* Read Graphics Controller Register=idx */
|
||
|
inline unsigned char RGfx (volatile unsigned char *regs, short idx)
|
||
|
{
|
||
|
wb_64 (regs, GCT_ADDRESS, idx);
|
||
|
mb();
|
||
|
return (rb_64(regs, GCT_ADDRESS_R));
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Special wakeup/passthrough registers on graphics boards
|
||
|
*/
|
||
|
|
||
|
inline void cv64_write_port (unsigned short bits,
|
||
|
volatile unsigned char *base)
|
||
|
{
|
||
|
volatile unsigned char *addr;
|
||
|
static unsigned char cvportbits = 0; /* Mirror port bits here */
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
addr = base + 0x40001;
|
||
|
if (bits & 0x8000) {
|
||
|
cvportbits |= bits & 0xff; /* Set bits */
|
||
|
DPRINTK("Set bits: %04x\n", bits);
|
||
|
} else {
|
||
|
bits = bits & 0xff;
|
||
|
bits = (~bits) & 0xff;
|
||
|
cvportbits &= bits; /* Clear bits */
|
||
|
DPRINTK("Clear bits: %04x\n", bits);
|
||
|
}
|
||
|
|
||
|
*addr = cvportbits;
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Monitor switch on CyberVision board
|
||
|
*
|
||
|
* toggle:
|
||
|
* 0 = CyberVision Signal
|
||
|
* 1 = Amiga Signal
|
||
|
* board = board addr
|
||
|
*
|
||
|
*/
|
||
|
inline void cvscreen (int toggle, volatile unsigned char *board)
|
||
|
{
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (toggle == 1) {
|
||
|
DPRINTK("Show Amiga video\n");
|
||
|
cv64_write_port (0x10, board);
|
||
|
} else {
|
||
|
DPRINTK("Show CyberVision video\n");
|
||
|
cv64_write_port (0x8010, board);
|
||
|
}
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
/* Control screen display */
|
||
|
/* toggle: 0 = on, 1 = off */
|
||
|
/* board = registerbase */
|
||
|
inline void gfx_on_off(int toggle, volatile unsigned char *regs)
|
||
|
{
|
||
|
int r;
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
toggle &= 0x1;
|
||
|
toggle = toggle << 5;
|
||
|
DPRINTK("Turn display %s\n", (toggle ? "off" : "on"));
|
||
|
|
||
|
r = (int) RSeq(regs, SEQ_ID_CLOCKING_MODE);
|
||
|
r &= 0xdf; /* Set bit 5 to 0 */
|
||
|
|
||
|
WSeq (regs, SEQ_ID_CLOCKING_MODE, r | toggle);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Computes M, N, and R values from
|
||
|
* given input frequency. It uses a table of
|
||
|
* precomputed values, to keep CPU time low.
|
||
|
*
|
||
|
* The return value consist of:
|
||
|
* lower byte: Bits 4-0: N Divider Value
|
||
|
* Bits 5-6: R Value for e.g. SR10 or SR12
|
||
|
* higher byte: Bits 0-6: M divider value for e.g. SR11 or SR13
|
||
|
*/
|
||
|
static unsigned short cv64_compute_clock(unsigned long freq)
|
||
|
{
|
||
|
static unsigned char *mnr, *save; /* M, N + R vals */
|
||
|
unsigned long work_freq, r;
|
||
|
unsigned short erg;
|
||
|
long diff, d2;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (freq < 12500000 || freq > MAXPIXELCLOCK) {
|
||
|
printk("CV64 driver: Illegal clock frequency %ld, using 25MHz\n",
|
||
|
freq);
|
||
|
freq = 25000000;
|
||
|
}
|
||
|
DPRINTK("Freq = %ld\n", freq);
|
||
|
mnr = clocks; /* there the vals are stored */
|
||
|
d2 = 0x7fffffff;
|
||
|
|
||
|
while (*mnr) { /* mnr vals are 0-terminated */
|
||
|
work_freq = (0x37EE * (mnr[0] + 2)) / ((mnr[1] & 0x1F) + 2);
|
||
|
|
||
|
r = (mnr[1] >> 5) & 0x03;
|
||
|
if (r != 0) {
|
||
|
work_freq = work_freq >> r; /* r is the freq divider */
|
||
|
}
|
||
|
|
||
|
work_freq *= 0x3E8; /* 2nd part of OSC */
|
||
|
|
||
|
diff = abs(freq - work_freq);
|
||
|
|
||
|
if (d2 >= diff) {
|
||
|
d2 = diff;
|
||
|
/* In save are the vals for minimal diff */
|
||
|
save = mnr;
|
||
|
}
|
||
|
mnr += 2;
|
||
|
}
|
||
|
erg = *((unsigned short *)save);
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
return (erg);
|
||
|
}
|
||
|
|
||
|
static int cv_has_4mb (volatile unsigned char *fb)
|
||
|
{
|
||
|
volatile unsigned long *tr, *tw;
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
/* write patterns in memory and test if they can be read */
|
||
|
tw = (volatile unsigned long *) fb;
|
||
|
tr = (volatile unsigned long *) (fb + 0x02000000);
|
||
|
|
||
|
*tw = 0x87654321;
|
||
|
|
||
|
if (*tr != 0x87654321) {
|
||
|
DPRINTK("EXIT - <4MB\n");
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
/* upper memory region */
|
||
|
tw = (volatile unsigned long *) (fb + 0x00200000);
|
||
|
tr = (volatile unsigned long *) (fb + 0x02200000);
|
||
|
|
||
|
*tw = 0x87654321;
|
||
|
|
||
|
if (*tr != 0x87654321) {
|
||
|
DPRINTK("EXIT - <4MB\n");
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
*tw = 0xAAAAAAAA;
|
||
|
|
||
|
if (*tr != 0xAAAAAAAA) {
|
||
|
DPRINTK("EXIT - <4MB\n");
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
*tw = 0x55555555;
|
||
|
|
||
|
if (*tr != 0x55555555) {
|
||
|
DPRINTK("EXIT - <4MB\n");
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
return (1);
|
||
|
}
|
||
|
|
||
|
static void cv64_board_init (void)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
int i;
|
||
|
unsigned int clockpar;
|
||
|
unsigned char test;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
|
||
|
/*
|
||
|
* Special CyberVision 64 board operations
|
||
|
*/
|
||
|
/* Reset board */
|
||
|
for (i = 0; i < 6; i++) {
|
||
|
cv64_write_port (0xff, CyberBase);
|
||
|
}
|
||
|
/* Return to operational mode */
|
||
|
cv64_write_port (0x8004, CyberBase);
|
||
|
|
||
|
/*
|
||
|
* Generic (?) S3 chip wakeup
|
||
|
*/
|
||
|
/* Disable I/O & memory decoders, video in setup mode */
|
||
|
wb_64 (regs, SREG_VIDEO_SUBS_ENABLE, 0x10);
|
||
|
/* Video responds to cmds, addrs & data */
|
||
|
wb_64 (regs, SREG_OPTION_SELECT, 0x1);
|
||
|
/* Enable I/O & memory decoders, video in operational mode */
|
||
|
wb_64 (regs, SREG_VIDEO_SUBS_ENABLE, 0x8);
|
||
|
/* VGA color emulation, enable cpu access to display mem */
|
||
|
wb_64 (regs, GREG_MISC_OUTPUT_W, 0x03);
|
||
|
/* Unlock S3 VGA regs */
|
||
|
WCrt (regs, CRT_ID_REGISTER_LOCK_1, 0x48);
|
||
|
/* Unlock system control & extension registers */
|
||
|
WCrt (regs, CRT_ID_REGISTER_LOCK_2, 0xA5);
|
||
|
/* GRF - Enable interrupts */
|
||
|
/* Enable enhanced regs access, Ready cntl 0 wait states */
|
||
|
test = RCrt (regs, CRT_ID_SYSTEM_CONFIG);
|
||
|
test = test | 0x01; /* enable enhanced register access */
|
||
|
test = test & 0xEF; /* clear bit 4, 0 wait state */
|
||
|
WCrt (regs, CRT_ID_SYSTEM_CONFIG, test);
|
||
|
/*
|
||
|
* bit 0=1: Enable enhaced mode functions
|
||
|
* bit 2=0: Enhanced mode 8+ bits/pixel
|
||
|
* bit 4=1: Enable linear addressing
|
||
|
* bit 5=1: Enable MMIO
|
||
|
*/
|
||
|
wb_64 (regs, ECR_ADV_FUNC_CNTL, 0x31);
|
||
|
/*
|
||
|
* bit 0=1: Color emulation
|
||
|
* bit 1=1: Enable CPU access to display memory
|
||
|
* bit 5=1: Select high 64K memory page
|
||
|
*/
|
||
|
/* GRF - 0xE3 */
|
||
|
wb_64 (regs, GREG_MISC_OUTPUT_W, 0x23);
|
||
|
|
||
|
/* Cpu base addr */
|
||
|
WCrt (regs, CRT_ID_EXT_SYS_CNTL_4, 0x0);
|
||
|
|
||
|
/* Reset. This does nothing on Trio, but standard VGA practice */
|
||
|
/* WSeq (CyberRegs, SEQ_ID_RESET, 0x03); */
|
||
|
/* Character clocks 8 dots wide */
|
||
|
WSeq (regs, SEQ_ID_CLOCKING_MODE, 0x01);
|
||
|
/* Enable cpu write to all color planes */
|
||
|
WSeq (regs, SEQ_ID_MAP_MASK, 0x0F);
|
||
|
/* Font table in 1st 8k of plane 2, font A=B disables swtich */
|
||
|
WSeq (regs, SEQ_ID_CHAR_MAP_SELECT, 0x0);
|
||
|
/* Allow mem access to 256kb */
|
||
|
WSeq (regs, SEQ_ID_MEMORY_MODE, 0x2);
|
||
|
/* Unlock S3 extensions to VGA Sequencer regs */
|
||
|
WSeq (regs, SEQ_ID_UNLOCK_EXT, 0x6);
|
||
|
|
||
|
/* Enable 4MB fast page mode */
|
||
|
test = RSeq (regs, SEQ_ID_BUS_REQ_CNTL);
|
||
|
test = test | 1 << 6;
|
||
|
WSeq (regs, SEQ_ID_BUS_REQ_CNTL, test);
|
||
|
|
||
|
/* Faster LUT write: 1 DCLK LUT write cycle, RAMDAC clk doubled */
|
||
|
WSeq (regs, SEQ_ID_RAMDAC_CNTL, 0xC0);
|
||
|
|
||
|
/* Clear immediate clock load bit */
|
||
|
test = RSeq (regs, SEQ_ID_CLKSYN_CNTL_2);
|
||
|
test = test & 0xDF;
|
||
|
/* If > 55MHz, enable 2 cycle memory write */
|
||
|
if (cv64_memclk >= 55000000) {
|
||
|
test |= 0x80;
|
||
|
}
|
||
|
WSeq (regs, SEQ_ID_CLKSYN_CNTL_2, test);
|
||
|
|
||
|
/* Set MCLK value */
|
||
|
clockpar = cv64_compute_clock (cv64_memclk);
|
||
|
test = (clockpar & 0xFF00) >> 8;
|
||
|
WSeq (regs, SEQ_ID_MCLK_HI, test);
|
||
|
test = clockpar & 0xFF;
|
||
|
WSeq (regs, SEQ_ID_MCLK_LO, test);
|
||
|
|
||
|
/* Chip rev specific: Not in my Trio manual!!! */
|
||
|
if (RCrt (regs, CRT_ID_REVISION) == 0x10)
|
||
|
WSeq (regs, SEQ_ID_MORE_MAGIC, test);
|
||
|
|
||
|
/* We now load an 25 MHz, 31kHz, 640x480 standard VGA Mode. */
|
||
|
|
||
|
/* Set DCLK value */
|
||
|
WSeq (regs, SEQ_ID_DCLK_HI, 0x13);
|
||
|
WSeq (regs, SEQ_ID_DCLK_LO, 0x41);
|
||
|
|
||
|
/* Load DCLK (and MCLK?) immediately */
|
||
|
test = RSeq (regs, SEQ_ID_CLKSYN_CNTL_2);
|
||
|
test = test | 0x22;
|
||
|
WSeq (regs, SEQ_ID_CLKSYN_CNTL_2, test);
|
||
|
|
||
|
/* Enable loading of DCLK */
|
||
|
test = rb_64(regs, GREG_MISC_OUTPUT_R);
|
||
|
test = test | 0x0C;
|
||
|
wb_64 (regs, GREG_MISC_OUTPUT_W, test);
|
||
|
|
||
|
/* Turn off immediate xCLK load */
|
||
|
WSeq (regs, SEQ_ID_CLKSYN_CNTL_2, 0x2);
|
||
|
|
||
|
/* Horizontal character clock counts */
|
||
|
/* 8 LSB of 9 bits = total line - 5 */
|
||
|
WCrt (regs, CRT_ID_HOR_TOTAL, 0x5F);
|
||
|
/* Active display line */
|
||
|
WCrt (regs, CRT_ID_HOR_DISP_ENA_END, 0x4F);
|
||
|
/* Blank assertion start */
|
||
|
WCrt (regs, CRT_ID_START_HOR_BLANK, 0x50);
|
||
|
/* Blank assertion end */
|
||
|
WCrt (regs, CRT_ID_END_HOR_BLANK, 0x82);
|
||
|
/* HSYNC assertion start */
|
||
|
WCrt (regs, CRT_ID_START_HOR_RETR, 0x54);
|
||
|
/* HSYNC assertion end */
|
||
|
WCrt (regs, CRT_ID_END_HOR_RETR, 0x80);
|
||
|
WCrt (regs, CRT_ID_VER_TOTAL, 0xBF);
|
||
|
WCrt (regs, CRT_ID_OVERFLOW, 0x1F);
|
||
|
WCrt (regs, CRT_ID_PRESET_ROW_SCAN, 0x0);
|
||
|
WCrt (regs, CRT_ID_MAX_SCAN_LINE, 0x40);
|
||
|
WCrt (regs, CRT_ID_CURSOR_START, 0x00);
|
||
|
WCrt (regs, CRT_ID_CURSOR_END, 0x00);
|
||
|
WCrt (regs, CRT_ID_START_ADDR_HIGH, 0x00);
|
||
|
WCrt (regs, CRT_ID_START_ADDR_LOW, 0x00);
|
||
|
WCrt (regs, CRT_ID_CURSOR_LOC_HIGH, 0x00);
|
||
|
WCrt (regs, CRT_ID_CURSOR_LOC_LOW, 0x00);
|
||
|
WCrt (regs, CRT_ID_START_VER_RETR, 0x9C);
|
||
|
WCrt (regs, CRT_ID_END_VER_RETR, 0x0E);
|
||
|
WCrt (regs, CRT_ID_VER_DISP_ENA_END, 0x8F);
|
||
|
WCrt (regs, CRT_ID_SCREEN_OFFSET, 0x50);
|
||
|
WCrt (regs, CRT_ID_UNDERLINE_LOC, 0x00);
|
||
|
WCrt (regs, CRT_ID_START_VER_BLANK, 0x96);
|
||
|
WCrt (regs, CRT_ID_END_VER_BLANK, 0xB9);
|
||
|
WCrt (regs, CRT_ID_MODE_CONTROL, 0xE3);
|
||
|
WCrt (regs, CRT_ID_LINE_COMPARE, 0xFF);
|
||
|
WCrt (regs, CRT_ID_BACKWAD_COMP_3, 0x10); /* FIFO enabled */
|
||
|
WCrt (regs, CRT_ID_MISC_1, 0x35);
|
||
|
WCrt (regs, CRT_ID_DISPLAY_FIFO, 0x5A);
|
||
|
WCrt (regs, CRT_ID_EXT_MEM_CNTL_2, 0x70);
|
||
|
WCrt (regs, CRT_ID_LAW_POS_LO, 0x40);
|
||
|
WCrt (regs, CRT_ID_EXT_MEM_CNTL_3, 0xFF);
|
||
|
|
||
|
WGfx (regs, GCT_ID_SET_RESET, 0x0);
|
||
|
WGfx (regs, GCT_ID_ENABLE_SET_RESET, 0x0);
|
||
|
WGfx (regs, GCT_ID_COLOR_COMPARE, 0x0);
|
||
|
WGfx (regs, GCT_ID_DATA_ROTATE, 0x0);
|
||
|
WGfx (regs, GCT_ID_READ_MAP_SELECT, 0x0);
|
||
|
WGfx (regs, GCT_ID_GRAPHICS_MODE, 0x40);
|
||
|
WGfx (regs, GCT_ID_MISC, 0x01);
|
||
|
WGfx (regs, GCT_ID_COLOR_XCARE, 0x0F);
|
||
|
WGfx (regs, GCT_ID_BITMASK, 0xFF);
|
||
|
|
||
|
/* Colors for text mode */
|
||
|
for (i = 0; i < 0xf; i++)
|
||
|
WAttr (regs, i, i);
|
||
|
|
||
|
WAttr (regs, ACT_ID_ATTR_MODE_CNTL, 0x41);
|
||
|
WAttr (regs, ACT_ID_OVERSCAN_COLOR, 0x01);
|
||
|
WAttr (regs, ACT_ID_COLOR_PLANE_ENA, 0x0F);
|
||
|
WAttr (regs, ACT_ID_HOR_PEL_PANNING, 0x0);
|
||
|
WAttr (regs, ACT_ID_COLOR_SELECT, 0x0);
|
||
|
|
||
|
wb_64 (regs, VDAC_MASK, 0xFF);
|
||
|
|
||
|
*((unsigned long *) (regs + ECR_FRGD_COLOR)) = 0xFF;
|
||
|
*((unsigned long *) (regs + ECR_BKGD_COLOR)) = 0;
|
||
|
|
||
|
/* Colors initially set to grayscale */
|
||
|
|
||
|
wb_64 (regs, VDAC_ADDRESS_W, 0);
|
||
|
for (i = 255; i >= 0; i--) {
|
||
|
wb_64(regs, VDAC_DATA, i);
|
||
|
wb_64(regs, VDAC_DATA, i);
|
||
|
wb_64(regs, VDAC_DATA, i);
|
||
|
}
|
||
|
|
||
|
/* GFx hardware cursor off */
|
||
|
WCrt (regs, CRT_ID_HWGC_MODE, 0x00);
|
||
|
|
||
|
/* Set first to 4MB, so test will work */
|
||
|
WCrt (regs, CRT_ID_LAW_CNTL, 0x13);
|
||
|
/* Find "correct" size of fbmem of Z3 board */
|
||
|
if (cv_has_4mb (CyberMem)) {
|
||
|
CyberSize = 1024 * 1024 * 4;
|
||
|
WCrt (regs, CRT_ID_LAW_CNTL, 0x13);
|
||
|
DPRINTK("4MB board\n");
|
||
|
} else {
|
||
|
CyberSize = 1024 * 1024 * 2;
|
||
|
WCrt (regs, CRT_ID_LAW_CNTL, 0x12);
|
||
|
DPRINTK("2MB board\n");
|
||
|
}
|
||
|
|
||
|
/* Initialize graphics engine */
|
||
|
Cyber_WaitBlit();
|
||
|
vgaw16 (regs, ECR_FRGD_MIX, 0x27);
|
||
|
vgaw16 (regs, ECR_BKGD_MIX, 0x07);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0x1000);
|
||
|
udelay(200);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0x2000);
|
||
|
Cyber_WaitBlit();
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0x3FFF);
|
||
|
Cyber_WaitBlit();
|
||
|
udelay(200);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0x4FFF);
|
||
|
Cyber_WaitBlit();
|
||
|
vgaw16 (regs, ECR_BITPLANE_WRITE_MASK, ~0);
|
||
|
Cyber_WaitBlit();
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0xE000);
|
||
|
vgaw16 (regs, ECR_CURRENT_Y_POS2, 0x00);
|
||
|
vgaw16 (regs, ECR_CURRENT_X_POS2, 0x00);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0xA000);
|
||
|
vgaw16 (regs, ECR_DEST_Y__AX_STEP, 0x00);
|
||
|
vgaw16 (regs, ECR_DEST_Y2__AX_STEP2, 0x00);
|
||
|
vgaw16 (regs, ECR_DEST_X__DIA_STEP, 0x00);
|
||
|
vgaw16 (regs, ECR_DEST_X2__DIA_STEP2, 0x00);
|
||
|
vgaw16 (regs, ECR_SHORT_STROKE, 0x00);
|
||
|
vgaw16 (regs, ECR_DRAW_CMD, 0x01);
|
||
|
|
||
|
Cyber_WaitBlit();
|
||
|
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0x4FFF);
|
||
|
vgaw16 (regs, ECR_BKGD_COLOR, 0x01);
|
||
|
vgaw16 (regs, ECR_FRGD_COLOR, 0x00);
|
||
|
|
||
|
|
||
|
/* Enable video display (set bit 5) */
|
||
|
/* ARB - Would also seem to write to AR13.
|
||
|
* May want to use parts of WAttr to set JUST bit 5
|
||
|
*/
|
||
|
WAttr (regs, 0x33, 0);
|
||
|
|
||
|
/* GRF - function code ended here */
|
||
|
|
||
|
/* Turn gfx on again */
|
||
|
gfx_on_off (0, regs);
|
||
|
|
||
|
/* Pass-through */
|
||
|
cvscreen (0, CyberBase);
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
static void cv64_load_video_mode (struct fb_var_screeninfo *video_mode)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
int fx, fy;
|
||
|
unsigned short mnr;
|
||
|
unsigned short HT, HDE, HBS, HBE, HSS, HSE, VDE, VBS, VBE, VSS, VSE, VT;
|
||
|
char LACE, DBLSCAN, TEXT, CONSOLE;
|
||
|
int cr50, sr15, sr18, clock_mode, test;
|
||
|
int m, n;
|
||
|
int tfillm, temptym;
|
||
|
int hmul;
|
||
|
|
||
|
/* ---------------- */
|
||
|
int xres, hfront, hsync, hback;
|
||
|
int yres, vfront, vsync, vback;
|
||
|
int bpp;
|
||
|
#if 0
|
||
|
float freq_f;
|
||
|
#endif
|
||
|
long freq;
|
||
|
/* ---------------- */
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
TEXT = 0; /* if depth == 4 */
|
||
|
CONSOLE = 0; /* mode num == 255 (console) */
|
||
|
fx = fy = 8; /* force 8x8 font */
|
||
|
|
||
|
/* GRF - Disable interrupts */
|
||
|
|
||
|
gfx_on_off (1, regs);
|
||
|
|
||
|
switch (video_mode->bits_per_pixel) {
|
||
|
case 15:
|
||
|
case 16:
|
||
|
hmul = 2;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
hmul = 1;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
bpp = video_mode->bits_per_pixel;
|
||
|
xres = video_mode->xres;
|
||
|
hfront = video_mode->right_margin;
|
||
|
hsync = video_mode->hsync_len;
|
||
|
hback = video_mode->left_margin;
|
||
|
|
||
|
LACE = 0;
|
||
|
DBLSCAN = 0;
|
||
|
|
||
|
if (video_mode->vmode & FB_VMODE_DOUBLE) {
|
||
|
yres = video_mode->yres * 2;
|
||
|
vfront = video_mode->lower_margin * 2;
|
||
|
vsync = video_mode->vsync_len * 2;
|
||
|
vback = video_mode->upper_margin * 2;
|
||
|
DBLSCAN = 1;
|
||
|
} else if (video_mode->vmode & FB_VMODE_INTERLACED) {
|
||
|
yres = (video_mode->yres + 1) / 2;
|
||
|
vfront = (video_mode->lower_margin + 1) / 2;
|
||
|
vsync = (video_mode->vsync_len + 1) / 2;
|
||
|
vback = (video_mode->upper_margin + 1) / 2;
|
||
|
LACE = 1;
|
||
|
} else {
|
||
|
yres = video_mode->yres;
|
||
|
vfront = video_mode->lower_margin;
|
||
|
vsync = video_mode->vsync_len;
|
||
|
vback = video_mode->upper_margin;
|
||
|
}
|
||
|
|
||
|
/* ARB Dropping custom setup method from cvision.c */
|
||
|
#if 0
|
||
|
if (cvision_custom_mode) {
|
||
|
HBS = hbs / 8 * hmul;
|
||
|
HBE = hbe / 8 * hmul;
|
||
|
HSS = hss / 8 * hmul;
|
||
|
HSE = hse / 8 * hmul;
|
||
|
HT = ht / 8 * hmul - 5;
|
||
|
|
||
|
VBS = vbs - 1;
|
||
|
VSS = vss;
|
||
|
VSE = vse;
|
||
|
VBE = vbe;
|
||
|
VT = vt - 2;
|
||
|
} else {
|
||
|
#else
|
||
|
{
|
||
|
#endif
|
||
|
HBS = hmul * (xres / 8);
|
||
|
HBE = hmul * ((xres/8) + (hfront/8) + (hsync/8) + (hback/8) - 2);
|
||
|
HSS = hmul * ((xres/8) + (hfront/8) + 2);
|
||
|
HSE = hmul * ((xres/8) + (hfront/8) + (hsync/8) + 1);
|
||
|
HT = hmul * ((xres/8) + (hfront/8) + (hsync/8) + (hback/8));
|
||
|
|
||
|
VBS = yres;
|
||
|
VBE = yres + vfront + vsync + vback - 2;
|
||
|
VSS = yres + vfront - 1;
|
||
|
VSE = yres + vfront + vsync - 1;
|
||
|
VT = yres + vfront + vsync + vback - 2;
|
||
|
}
|
||
|
|
||
|
wb_64 (regs, ECR_ADV_FUNC_CNTL, (TEXT ? 0x00 : 0x31));
|
||
|
|
||
|
if (TEXT)
|
||
|
HDE = ((video_mode->xres + fx - 1) / fx) - 1;
|
||
|
else
|
||
|
HDE = (video_mode->xres + 3) * hmul / 8 - 1;
|
||
|
|
||
|
VDE = video_mode->yres - 1;
|
||
|
|
||
|
WCrt (regs, CRT_ID_HWGC_MODE, 0x00);
|
||
|
WCrt (regs, CRT_ID_EXT_DAC_CNTL, 0x00);
|
||
|
|
||
|
WSeq (regs, SEQ_ID_MEMORY_MODE,
|
||
|
(TEXT || (video_mode->bits_per_pixel == 1)) ? 0x06 : 0x0e);
|
||
|
WGfx (regs, GCT_ID_READ_MAP_SELECT, 0x00);
|
||
|
WSeq (regs, SEQ_ID_MAP_MASK,
|
||
|
(video_mode->bits_per_pixel == 1) ? 0x01 : 0xFF);
|
||
|
WSeq (regs, SEQ_ID_CHAR_MAP_SELECT, 0x00);
|
||
|
|
||
|
/* cv64_compute_clock accepts arguments in Hz */
|
||
|
/* pixclock is in ps ... convert to Hz */
|
||
|
|
||
|
#if 0
|
||
|
freq_f = (1.0 / (float) video_mode->pixclock) * 1000000000;
|
||
|
freq = ((long) freq_f) * 1000;
|
||
|
#else
|
||
|
/* freq = (long) ((long long)1000000000000 / (long long) video_mode->pixclock);
|
||
|
*/
|
||
|
freq = (1000000000 / video_mode->pixclock) * 1000;
|
||
|
#endif
|
||
|
|
||
|
mnr = cv64_compute_clock (freq);
|
||
|
WSeq (regs, SEQ_ID_DCLK_HI, ((mnr & 0xFF00) >> 8));
|
||
|
WSeq (regs, SEQ_ID_DCLK_LO, (mnr & 0xFF));
|
||
|
|
||
|
/* Load display parameters into board */
|
||
|
WCrt (regs, CRT_ID_EXT_HOR_OVF,
|
||
|
((HT & 0x100) ? 0x01 : 0x00) |
|
||
|
((HDE & 0x100) ? 0x02 : 0x00) |
|
||
|
((HBS & 0x100) ? 0x04 : 0x00) |
|
||
|
/* ((HBE & 0x40) ? 0x08 : 0x00) | */
|
||
|
((HSS & 0x100) ? 0x10 : 0x00) |
|
||
|
/* ((HSE & 0x20) ? 0x20 : 0x00) | */
|
||
|
(((HT-5) & 0x100) ? 0x40 : 0x00)
|
||
|
);
|
||
|
|
||
|
WCrt (regs, CRT_ID_EXT_VER_OVF,
|
||
|
0x40 |
|
||
|
((VT & 0x400) ? 0x01 : 0x00) |
|
||
|
((VDE & 0x400) ? 0x02 : 0x00) |
|
||
|
((VBS & 0x400) ? 0x04 : 0x00) |
|
||
|
((VSS & 0x400) ? 0x10 : 0x00)
|
||
|
);
|
||
|
|
||
|
WCrt (regs, CRT_ID_HOR_TOTAL, HT);
|
||
|
WCrt (regs, CRT_ID_DISPLAY_FIFO, HT - 5);
|
||
|
WCrt (regs, CRT_ID_HOR_DISP_ENA_END, ((HDE >= HBS) ? (HBS - 1) : HDE));
|
||
|
WCrt (regs, CRT_ID_START_HOR_BLANK, HBS);
|
||
|
WCrt (regs, CRT_ID_END_HOR_BLANK, ((HBE & 0x1F) | 0x80));
|
||
|
WCrt (regs, CRT_ID_START_HOR_RETR, HSS);
|
||
|
WCrt (regs, CRT_ID_END_HOR_RETR,
|
||
|
(HSE & 0x1F) |
|
||
|
((HBE & 0x20) ? 0x80 : 0x00)
|
||
|
);
|
||
|
WCrt (regs, CRT_ID_VER_TOTAL, VT);
|
||
|
WCrt (regs, CRT_ID_OVERFLOW,
|
||
|
0x10 |
|
||
|
((VT & 0x100) ? 0x01 : 0x00) |
|
||
|
((VDE & 0x100) ? 0x02 : 0x00) |
|
||
|
((VSS & 0x100) ? 0x04 : 0x00) |
|
||
|
((VBS & 0x100) ? 0x08 : 0x00) |
|
||
|
((VT & 0x200) ? 0x20 : 0x00) |
|
||
|
((VDE & 0x200) ? 0x40 : 0x00) |
|
||
|
((VSS & 0x200) ? 0x80 : 0x00)
|
||
|
);
|
||
|
WCrt (regs, CRT_ID_MAX_SCAN_LINE,
|
||
|
0x40 |
|
||
|
(DBLSCAN ? 0x80 : 0x00) |
|
||
|
((VBS & 0x200) ? 0x20 : 0x00) |
|
||
|
(TEXT ? ((fy - 1) & 0x1F) : 0x00)
|
||
|
);
|
||
|
|
||
|
WCrt (regs, CRT_ID_MODE_CONTROL, 0xE3);
|
||
|
|
||
|
/* Text cursor */
|
||
|
|
||
|
if (TEXT) {
|
||
|
#if 1
|
||
|
WCrt (regs, CRT_ID_CURSOR_START, (fy & 0x1f) - 2);
|
||
|
WCrt (regs, CRT_ID_CURSOR_END, (fy & 0x1F) - 1);
|
||
|
#else
|
||
|
WCrt (regs, CRT_ID_CURSOR_START, 0x00);
|
||
|
WCrt (regs, CRT_ID_CURSOR_END, fy & 0x1F);
|
||
|
#endif
|
||
|
WCrt (regs, CRT_ID_UNDERLINE_LOC, (fy - 1) & 0x1F);
|
||
|
WCrt (regs, CRT_ID_CURSOR_LOC_HIGH, 0x00);
|
||
|
WCrt (regs, CRT_ID_CURSOR_LOC_LOW, 0x00);
|
||
|
}
|
||
|
|
||
|
WCrt (regs, CRT_ID_START_ADDR_HIGH, 0x00);
|
||
|
WCrt (regs, CRT_ID_START_ADDR_LOW, 0x00);
|
||
|
WCrt (regs, CRT_ID_START_VER_RETR, VSS);
|
||
|
WCrt (regs, CRT_ID_END_VER_RETR, (VSE & 0x0F));
|
||
|
WCrt (regs, CRT_ID_VER_DISP_ENA_END, VDE);
|
||
|
WCrt (regs, CRT_ID_START_VER_BLANK, VBS);
|
||
|
WCrt (regs, CRT_ID_END_VER_BLANK, VBE);
|
||
|
WCrt (regs, CRT_ID_LINE_COMPARE, 0xFF);
|
||
|
WCrt (regs, CRT_ID_LACE_RETR_START, HT / 2);
|
||
|
WCrt (regs, CRT_ID_LACE_CONTROL, (LACE ? 0x20 : 0x00));
|
||
|
WGfx (regs, GCT_ID_GRAPHICS_MODE,
|
||
|
((TEXT || (video_mode->bits_per_pixel == 1)) ? 0x00 : 0x40));
|
||
|
WGfx (regs, GCT_ID_MISC, (TEXT ? 0x04 : 0x01));
|
||
|
WSeq (regs, SEQ_ID_MEMORY_MODE,
|
||
|
((TEXT || (video_mode->bits_per_pixel == 1)) ? 0x06 : 0x02));
|
||
|
|
||
|
wb_64 (regs, VDAC_MASK, 0xFF);
|
||
|
|
||
|
/* Blank border */
|
||
|
test = RCrt (regs, CRT_ID_BACKWAD_COMP_2);
|
||
|
WCrt (regs, CRT_ID_BACKWAD_COMP_2, (test | 0x20));
|
||
|
|
||
|
sr15 = RSeq (regs, SEQ_ID_CLKSYN_CNTL_2);
|
||
|
sr15 &= 0xEF;
|
||
|
sr18 = RSeq (regs, SEQ_ID_RAMDAC_CNTL);
|
||
|
sr18 &= 0x7F;
|
||
|
clock_mode = 0x00;
|
||
|
cr50 = 0x00;
|
||
|
|
||
|
test = RCrt (regs, CRT_ID_EXT_MISC_CNTL_2);
|
||
|
test &= 0xD;
|
||
|
|
||
|
/* Clear roxxler byte-swapping... */
|
||
|
cv64_write_port (0x0040, CyberBase);
|
||
|
cv64_write_port (0x0020, CyberBase);
|
||
|
|
||
|
switch (video_mode->bits_per_pixel) {
|
||
|
case 1:
|
||
|
case 4: /* text */
|
||
|
HDE = video_mode->xres / 16;
|
||
|
break;
|
||
|
|
||
|
case 8:
|
||
|
if (freq > 80000000) {
|
||
|
clock_mode = 0x10 | 0x02;
|
||
|
sr15 |= 0x10;
|
||
|
sr18 |= 0x80;
|
||
|
}
|
||
|
HDE = video_mode->xres / 8;
|
||
|
cr50 |= 0x00;
|
||
|
break;
|
||
|
|
||
|
case 15:
|
||
|
cv64_write_port (0x8020, CyberBase);
|
||
|
clock_mode = 0x30;
|
||
|
HDE = video_mode->xres / 4;
|
||
|
cr50 |= 0x10;
|
||
|
break;
|
||
|
|
||
|
case 16:
|
||
|
cv64_write_port (0x8020, CyberBase);
|
||
|
clock_mode = 0x50;
|
||
|
HDE = video_mode->xres / 4;
|
||
|
cr50 |= 0x10;
|
||
|
break;
|
||
|
|
||
|
case 24:
|
||
|
case 32:
|
||
|
cv64_write_port (0x8040, CyberBase);
|
||
|
clock_mode = 0xD0;
|
||
|
HDE = video_mode->xres / 2;
|
||
|
cr50 |= 0x30;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
WCrt (regs, CRT_ID_EXT_MISC_CNTL_2, clock_mode | test);
|
||
|
WSeq (regs, SEQ_ID_CLKSYN_CNTL_2, sr15);
|
||
|
WSeq (regs, SEQ_ID_RAMDAC_CNTL, sr18);
|
||
|
WCrt (regs, CRT_ID_SCREEN_OFFSET, HDE);
|
||
|
|
||
|
WCrt (regs, CRT_ID_MISC_1, (TEXT ? 0x05 : 0x35));
|
||
|
|
||
|
test = RCrt (regs, CRT_ID_EXT_SYS_CNTL_2);
|
||
|
test &= ~0x30;
|
||
|
test |= (HDE >> 4) & 0x30;
|
||
|
WCrt (regs, CRT_ID_EXT_SYS_CNTL_2, test);
|
||
|
|
||
|
/* Set up graphics engine */
|
||
|
switch (video_mode->xres) {
|
||
|
case 1024:
|
||
|
cr50 |= 0x00;
|
||
|
break;
|
||
|
|
||
|
case 640:
|
||
|
cr50 |= 0x40;
|
||
|
break;
|
||
|
|
||
|
case 800:
|
||
|
cr50 |= 0x80;
|
||
|
break;
|
||
|
|
||
|
case 1280:
|
||
|
cr50 |= 0xC0;
|
||
|
break;
|
||
|
|
||
|
case 1152:
|
||
|
cr50 |= 0x01;
|
||
|
break;
|
||
|
|
||
|
case 1600:
|
||
|
cr50 |= 0x81;
|
||
|
break;
|
||
|
|
||
|
default: /* XXX */
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
WCrt (regs, CRT_ID_EXT_SYS_CNTL_1, cr50);
|
||
|
|
||
|
udelay(100);
|
||
|
WAttr (regs, ACT_ID_ATTR_MODE_CNTL, (TEXT ? 0x08 : 0x41));
|
||
|
udelay(100);
|
||
|
WAttr (regs, ACT_ID_COLOR_PLANE_ENA,
|
||
|
(video_mode->bits_per_pixel == 1) ? 0x01 : 0x0F);
|
||
|
udelay(100);
|
||
|
|
||
|
tfillm = (96 * (cv64_memclk / 1000)) / 240000;
|
||
|
|
||
|
switch (video_mode->bits_per_pixel) {
|
||
|
case 32:
|
||
|
case 24:
|
||
|
temptym = (24 * (cv64_memclk / 1000)) / (freq / 1000);
|
||
|
break;
|
||
|
case 15:
|
||
|
case 16:
|
||
|
temptym = (48 * (cv64_memclk / 1000)) / (freq / 1000);
|
||
|
break;
|
||
|
case 4:
|
||
|
temptym = (192 * (cv64_memclk / 1000)) / (freq / 1000);
|
||
|
break;
|
||
|
default:
|
||
|
temptym = (96 * (cv64_memclk / 1000)) / (freq / 1000);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
m = (temptym - tfillm - 9) / 2;
|
||
|
if (m < 0)
|
||
|
m = 0;
|
||
|
m = (m & 0x1F) << 3;
|
||
|
if (m < 0x18)
|
||
|
m = 0x18;
|
||
|
n = 0xFF;
|
||
|
|
||
|
WCrt (regs, CRT_ID_EXT_MEM_CNTL_2, m);
|
||
|
WCrt (regs, CRT_ID_EXT_MEM_CNTL_3, n);
|
||
|
udelay(10);
|
||
|
|
||
|
/* Text initialization */
|
||
|
|
||
|
if (TEXT) {
|
||
|
/* Do text initialization here ! */
|
||
|
}
|
||
|
|
||
|
if (CONSOLE) {
|
||
|
int i;
|
||
|
wb_64 (regs, VDAC_ADDRESS_W, 0);
|
||
|
for (i = 0; i < 4; i++) {
|
||
|
wb_64 (regs, VDAC_DATA, cvconscolors [i][0]);
|
||
|
wb_64 (regs, VDAC_DATA, cvconscolors [i][1]);
|
||
|
wb_64 (regs, VDAC_DATA, cvconscolors [i][2]);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
WAttr (regs, 0x33, 0);
|
||
|
|
||
|
/* Turn gfx on again */
|
||
|
gfx_on_off (0, (volatile unsigned char *) regs);
|
||
|
|
||
|
/* Pass-through */
|
||
|
cvscreen (0, CyberBase);
|
||
|
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
void cvision_bitblt (u_short sx, u_short sy, u_short dx, u_short dy,
|
||
|
u_short w, u_short h)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
unsigned short drawdir = 0;
|
||
|
|
||
|
DPRINTK("ENTER\n");
|
||
|
if (sx > dx) {
|
||
|
drawdir |= 1 << 5;
|
||
|
} else {
|
||
|
sx += w - 1;
|
||
|
dx += w - 1;
|
||
|
}
|
||
|
|
||
|
if (sy > dy) {
|
||
|
drawdir |= 1 << 7;
|
||
|
} else {
|
||
|
sy += h - 1;
|
||
|
dy += h - 1;
|
||
|
}
|
||
|
|
||
|
Cyber_WaitBlit();
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0xA000);
|
||
|
vgaw16 (regs, ECR_BKGD_MIX, 0x7);
|
||
|
vgaw16 (regs, ECR_FRGD_MIX, 0x67);
|
||
|
vgaw16 (regs, ECR_BKGD_COLOR, 0x0);
|
||
|
vgaw16 (regs, ECR_FRGD_COLOR, 0x1);
|
||
|
vgaw16 (regs, ECR_BITPLANE_READ_MASK, 0x1);
|
||
|
vgaw16 (regs, ECR_BITPLANE_WRITE_MASK, 0xFFF);
|
||
|
vgaw16 (regs, ECR_CURRENT_Y_POS, sy);
|
||
|
vgaw16 (regs, ECR_CURRENT_X_POS, sx);
|
||
|
vgaw16 (regs, ECR_DEST_Y__AX_STEP, dy);
|
||
|
vgaw16 (regs, ECR_DEST_X__DIA_STEP, dx);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, h - 1);
|
||
|
vgaw16 (regs, ECR_MAJ_AXIS_PIX_CNT, w - 1);
|
||
|
vgaw16 (regs, ECR_DRAW_CMD, 0xC051 | drawdir);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
void cvision_clear (u_short dx, u_short dy, u_short w, u_short h, u_short bg)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
DPRINTK("ENTER\n");
|
||
|
Cyber_WaitBlit();
|
||
|
vgaw16 (regs, ECR_FRGD_MIX, 0x0027);
|
||
|
vgaw16 (regs, ECR_FRGD_COLOR, bg);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, 0xA000);
|
||
|
vgaw16 (regs, ECR_CURRENT_Y_POS, dy);
|
||
|
vgaw16 (regs, ECR_CURRENT_X_POS, dx);
|
||
|
vgaw16 (regs, ECR_READ_REG_DATA, h - 1);
|
||
|
vgaw16 (regs, ECR_MAJ_AXIS_PIX_CNT, w - 1);
|
||
|
vgaw16 (regs, ECR_DRAW_CMD, 0x40B1);
|
||
|
DPRINTK("EXIT\n");
|
||
|
}
|
||
|
|
||
|
#ifdef CYBERFBDEBUG
|
||
|
/*
|
||
|
* Dump internal settings of CyberVision board
|
||
|
*/
|
||
|
static void cv64_dump (void)
|
||
|
{
|
||
|
volatile unsigned char *regs = CyberRegs;
|
||
|
DPRINTK("ENTER\n");
|
||
|
/* Dump the VGA setup values */
|
||
|
*(regs + S3_CRTC_ADR) = 0x00;
|
||
|
DPRINTK("CR00 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x01;
|
||
|
DPRINTK("CR01 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x02;
|
||
|
DPRINTK("CR02 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x03;
|
||
|
DPRINTK("CR03 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x04;
|
||
|
DPRINTK("CR04 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x05;
|
||
|
DPRINTK("CR05 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x06;
|
||
|
DPRINTK("CR06 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x07;
|
||
|
DPRINTK("CR07 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x08;
|
||
|
DPRINTK("CR08 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x09;
|
||
|
DPRINTK("CR09 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x10;
|
||
|
DPRINTK("CR10 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x11;
|
||
|
DPRINTK("CR11 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x12;
|
||
|
DPRINTK("CR12 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x13;
|
||
|
DPRINTK("CR13 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x15;
|
||
|
DPRINTK("CR15 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x16;
|
||
|
DPRINTK("CR16 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x36;
|
||
|
DPRINTK("CR36 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x37;
|
||
|
DPRINTK("CR37 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x42;
|
||
|
DPRINTK("CR42 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x43;
|
||
|
DPRINTK("CR43 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x50;
|
||
|
DPRINTK("CR50 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x51;
|
||
|
DPRINTK("CR51 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x53;
|
||
|
DPRINTK("CR53 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x58;
|
||
|
DPRINTK("CR58 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x59;
|
||
|
DPRINTK("CR59 = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x5A;
|
||
|
DPRINTK("CR5A = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x5D;
|
||
|
DPRINTK("CR5D = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
*(regs + S3_CRTC_ADR) = 0x5E;
|
||
|
DPRINTK("CR5E = %x\n", *(regs + S3_CRTC_DATA));
|
||
|
DPRINTK("MISC = %x\n", *(regs + GREG_MISC_OUTPUT_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x01;
|
||
|
DPRINTK("SR01 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x02;
|
||
|
DPRINTK("SR02 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x03;
|
||
|
DPRINTK("SR03 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x09;
|
||
|
DPRINTK("SR09 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x10;
|
||
|
DPRINTK("SR10 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x11;
|
||
|
DPRINTK("SR11 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x12;
|
||
|
DPRINTK("SR12 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x13;
|
||
|
DPRINTK("SR13 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
*(regs + SEQ_ADDRESS) = 0x15;
|
||
|
DPRINTK("SR15 = %x\n", *(regs + SEQ_ADDRESS_R));
|
||
|
|
||
|
return;
|
||
|
}
|
||
|
#endif
|