lkml.org 
[lkml]   [2002]   [Dec]   [4]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
Patch in this message
/
Subject[PATCH 3/3] FBDEV: rivafb + save/restore state
From
Date
Hi,

Attached is a patch against linux-2.5.50 + James Simmons fbdev.diff.

Added support to save and restore vgacon's text mode. Can also restore
VGA graphics mode.

Tony


diff -Naur linux-2.5.50-js/drivers/video/Makefile linux/drivers/video/Makefile
--- linux-2.5.50-js/drivers/video/Makefile 2002-12-04 15:22:38.000000000 +0000
+++ linux/drivers/video/Makefile 2002-12-04 15:24:50.000000000 +0000
@@ -69,7 +69,8 @@
obj-$(CONFIG_FB_TX3912) += tx3912fb.o cfbfillrect.o cfbcopyarea.o cfbimgblt.o

obj-$(CONFIG_FB_MATROX) += matrox/
-obj-$(CONFIG_FB_RIVA) += riva/ cfbfillrect.o cfbcopyarea.o cfbimgblt.o
+obj-$(CONFIG_FB_RIVA) += riva/ cfbfillrect.o cfbcopyarea.o \
+ cfbimgblt.o vgastate.o
obj-$(CONFIG_FB_SIS) += sis/
obj-$(CONFIG_FB_ATY) += aty/ cfbimgblt.o

diff -Naur linux-2.5.50-js/drivers/video/riva/fbdev.c linux/drivers/video/riva/fbdev.c
--- linux-2.5.50-js/drivers/video/riva/fbdev.c 2002-12-04 15:26:25.000000000 +0000
+++ linux/drivers/video/riva/fbdev.c 2002-12-04 15:25:32.000000000 +0000
@@ -42,6 +42,7 @@
#ifdef CONFIG_MTRR
#include <asm/mtrr.h>
#endif
+
#include "rivafb.h"
#include "nvreg.h"

@@ -246,15 +247,12 @@

/* command line data, set in rivafb_setup() */
static u32 pseudo_palette[17];
-static char nomove = 0;
#ifdef CONFIG_MTRR
static char nomtrr __initdata = 0;
#endif

#ifndef MODULE
static char *mode_option __initdata = NULL;
-#else
-static char *font = NULL;
#endif

static struct fb_fix_screeninfo rivafb_fix = {
@@ -428,7 +426,7 @@
m = *((u32 *)mask)++;
for (j = 0; j < w/2; j++) {
tmp = 0;
-#if defined (__BIG_ENDIAN)
+#if defined (__BIG_ENDIAN__)
if (m & (1 << 31))
tmp = (b & (1 << 31)) ? fg << 16 : bg << 16;
b <<= 1;
@@ -1162,6 +1160,46 @@
* framebuffer operations
*
* ------------------------------------------------------------------------- */
+static int rivafb_open(struct fb_info *info, int user)
+{
+ struct riva_par *par = (struct riva_par *) info->par;
+ int cnt = atomic_read(&par->ref_count);
+
+ if (!cnt) {
+ memset(&par->state, 0, sizeof(struct fb_vgastate));
+ par->state.flags = VGA_SAVE_MODE | VGA_SAVE_FONTS;
+ /* save the DAC for Riva128 */
+ if (par->riva.Architecture == NV_ARCH_03)
+ par->state.flags |= VGA_SAVE_CMAP;
+ fb_save_vga(&par->state);
+
+ RivaGetConfig(&par->riva);
+ riva_save_state(par, &par->initial_state);
+ }
+
+ atomic_inc(&par->ref_count);
+ return 0;
+}
+
+static int rivafb_release(struct fb_info *info, int user)
+{
+ struct riva_par *par = (struct riva_par *) info->par;
+ int cnt = atomic_read(&par->ref_count);
+
+ if (!cnt)
+ return -EINVAL;
+ if (cnt == 1) {
+ par->riva.LockUnlock(&par->riva, 0);
+ par->riva.LoadStateExt(&par->riva, &par->initial_state.ext);
+
+ fb_restore_vga(&par->state);
+ par->riva.LockUnlock(&par->riva, 1);
+ }
+
+ atomic_dec(&par->ref_count);
+
+ return 0;
+}

static int rivafb_check_var(struct fb_var_screeninfo *var,
struct fb_info *info)
@@ -1493,6 +1531,8 @@
/* kernel interface */
static struct fb_ops riva_fb_ops = {
.owner = THIS_MODULE,
+ .fb_open = rivafb_open,
+ .fb_release = rivafb_release,
.fb_check_var = rivafb_check_var,
.fb_set_par = rivafb_set_par,
.fb_setcolreg = rivafb_setcolreg,
@@ -1535,6 +1575,106 @@
*
* ------------------------------------------------------------------------- */

+static void __devinit rivafb_get_mem_len(struct riva_par *par,
+ struct fb_fix_screeninfo *fix)
+{
+ RIVA_HW_INST *chip = &par->riva;
+
+ switch (chip->Architecture) {
+ case NV_ARCH_03:
+ if (chip->PFB[0x00000000/4] & 0x00000020) {
+ if (((chip->PMC[0x00000000/4] & 0xF0) == 0x20)
+ && ((chip->PMC[0x00000000/4] & 0x0F) >= 0x02)) {
+ /*
+ * SDRAM 128 ZX.
+ */
+ switch (chip->PFB[0x00000000/4] & 0x03) {
+ case 2:
+ fix->smem_len = 1024 * 1024 * 4;
+ break;
+ case 1:
+ fix->smem_len = 1024 * 1024 * 2;
+ break;
+ default:
+ fix->smem_len = 1024 * 1024 * 8;
+ break;
+ }
+ }
+ else {
+ fix->smem_len = 1024 * 1024 * 8;
+ }
+ }
+ else {
+ /*
+ * SGRAM 128.
+ */
+ switch (chip->PFB[0x00000000/4] & 0x00000003) {
+ case 0:
+ fix->smem_len = 1024 * 1024 * 8;
+ break;
+ case 2:
+ fix->smem_len = 1024 * 1024 * 4;
+ break;
+ default:
+ fix->smem_len = 1024 * 1024 * 2;
+ break;
+ }
+ }
+ break;
+ case NV_ARCH_04:
+ if (chip->PFB[0x00000000/4] & 0x00000100) {
+ fix->smem_len = (((chip->PFB[0x00000000/4] >> 12)
+ & 0x0F) * 1024 * 2 + 1024 * 2) * 1024;
+ }
+ else {
+ switch (chip->PFB[0x00000000/4] & 0x00000003) {
+ case 0:
+ fix->smem_len = 1024 * 1024 * 32;
+ break;
+ case 1:
+ fix->smem_len = 1024 * 1024 * 4;
+ break;
+ case 2:
+ fix->smem_len = 1024 * 1024 * 8;
+ break;
+ case 3:
+ default:
+ fix->smem_len = 1024 * 1024 * 16;
+ break;
+ }
+ }
+ break;
+ case NV_ARCH_10:
+ case NV_ARCH_20:
+ switch ((chip->PFB[0x0000020C/4] >> 20) & 0x000000FF) {
+ case 0x02:
+ fix->smem_len = 1024 * 1024 * 2;
+ break;
+ case 0x04:
+ fix->smem_len = 1024 * 1024 * 4;
+ break;
+ case 0x08:
+ fix->smem_len = 1024 * 1024 * 8;
+ break;
+ case 0x10:
+ fix->smem_len = 1024 * 1024 * 16;
+ break;
+ case 0x20:
+ fix->smem_len = 1024 * 1024 * 32;
+ break;
+ case 0x40:
+ fix->smem_len = 1024 * 1024 * 64;
+ break;
+ case 0x80:
+ fix->smem_len = 1024 * 1024 * 128;
+ break;
+ default:
+ fix->smem_len = 1024 * 1024 * 16;
+ break;
+ }
+ }
+}
+
static int __devinit rivafb_init_one(struct pci_dev *pd,
const struct pci_device_id *ent)
{
@@ -1586,14 +1726,22 @@
}

default_par->riva.EnableIRQ = 0;
- default_par->riva.PRAMDAC = (unsigned *)(default_par->ctrl_base + 0x00680000);
- default_par->riva.PFB = (unsigned *)(default_par->ctrl_base + 0x00100000);
- default_par->riva.PFIFO = (unsigned *)(default_par->ctrl_base + 0x00002000);
- default_par->riva.PGRAPH = (unsigned *)(default_par->ctrl_base + 0x00400000);
- default_par->riva.PEXTDEV = (unsigned *)(default_par->ctrl_base + 0x00101000);
- default_par->riva.PTIMER = (unsigned *)(default_par->ctrl_base + 0x00009000);
- default_par->riva.PMC = (unsigned *)(default_par->ctrl_base + 0x00000000);
- default_par->riva.FIFO = (unsigned *)(default_par->ctrl_base + 0x00800000);
+ default_par->riva.PRAMDAC = (unsigned *)(default_par->ctrl_base +
+ 0x00680000);
+ default_par->riva.PFB = (unsigned *)(default_par->ctrl_base +
+ 0x00100000);
+ default_par->riva.PFIFO = (unsigned *)(default_par->ctrl_base +
+ 0x00002000);
+ default_par->riva.PGRAPH = (unsigned *)(default_par->ctrl_base +
+ 0x00400000);
+ default_par->riva.PEXTDEV = (unsigned *)(default_par->ctrl_base +
+ 0x00101000);
+ default_par->riva.PTIMER = (unsigned *)(default_par->ctrl_base +
+ 0x00009000);
+ default_par->riva.PMC = (unsigned *)(default_par->ctrl_base +
+ 0x00000000);
+ default_par->riva.FIFO = (unsigned *)(default_par->ctrl_base +
+ 0x00800000);

default_par->riva.PCIO = (U008 *)(default_par->ctrl_base + 0x00601000);
default_par->riva.PDIO = (U008 *)(default_par->ctrl_base + 0x00681000);
@@ -1603,22 +1751,26 @@

switch (default_par->riva.Architecture) {
case NV_ARCH_03:
- default_par->riva.PRAMIN = (unsigned *)(info->screen_base + 0x00C00000);
+ default_par->riva.PRAMIN = (unsigned *)(info->screen_base +
+ 0x00C00000);
+ default_par->dclk_max = 256000000;
rivafb_fix.accel = FB_ACCEL_NV3;
break;
case NV_ARCH_04:
case NV_ARCH_10:
case NV_ARCH_20:
- default_par->riva.PCRTC = (unsigned *)(default_par->ctrl_base + 0x00600000);
- default_par->riva.PRAMIN = (unsigned *)(default_par->ctrl_base + 0x00710000);
+ default_par->riva.PCRTC = (unsigned *)(default_par->ctrl_base
+ + 0x00600000);
+ default_par->riva.PRAMIN = (unsigned *)(default_par->ctrl_base
+ + 0x00710000);
+ default_par->dclk_max = 250000000;
rivafb_fix.accel = FB_ACCEL_NV4;
break;
}

- RivaGetConfig(&default_par->riva);
+ rivafb_get_mem_len(default_par, &rivafb_fix);

- rivafb_fix.smem_len = default_par->riva.RamAmountKBytes * 1024;
- default_par->dclk_max = default_par->riva.MaxVClockFreqKHz * 1000;
+ info->par = default_par;

if (!request_mem_region(rivafb_fix.smem_start,
rivafb_fix.smem_len, "rivafb")) {
@@ -1648,14 +1800,6 @@
}
#endif /* CONFIG_MTRR */

- /* unlock io */
- CRTCout(default_par, 0x11, 0xFF);/* vgaHWunlock() + riva unlock(0x7F) */
- default_par->riva.LockUnlock(&default_par->riva, 0);
-
- info->par = default_par;
-
- riva_save_state(default_par, &default_par->initial_state);
-
if (riva_set_fbinfo(info) < 0) {
printk(KERN_ERR PFX "error setting initial video mode\n");
goto err_out_cursor;
@@ -1680,7 +1824,6 @@
return 0;

err_out_load_state:
- riva_load_state(default_par, &default_par->initial_state);
err_out_cursor:
/* err_out_iounmap_fb: */
iounmap(info->screen_base);
@@ -1704,8 +1847,6 @@
if (!info)
return;

- riva_load_state(par, &par->initial_state);
-
unregister_framebuffer(info);

#ifdef CONFIG_MTRR
@@ -1773,9 +1914,7 @@
int __init rivafb_init(void)
{
int err;
-#ifdef MODULE
- if (font) strncpy(fontname, font, sizeof(fontname)-1);
-#endif
+
err = pci_module_init(&rivafb_driver);
if (err)
return err;
diff -Naur linux-2.5.50-js/drivers/video/riva/rivafb.h linux/drivers/video/riva/rivafb.h
--- linux-2.5.50-js/drivers/video/riva/rivafb.h 2002-12-04 15:26:30.000000000 +0000
+++ linux/drivers/video/riva/rivafb.h 2002-12-04 15:25:11.000000000 +0000
@@ -34,7 +34,8 @@

struct riva_regs initial_state; /* initial startup video mode */
struct riva_regs current_state;
-
+ struct fb_vgastate state;
+ atomic_t ref_count;
riva_cfb8_cmap_t cmap[256]; /* VGA DAC palette cache */
u32 riva_palette[16];
u32 cursor_data[32 * 32/4];
\
 
 \ /
  Last update: 2005-03-22 13:31    [W:0.166 / U:0.144 seconds]
©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site