Gedichte Musik Bilder Quellcodebibliothek Diashow Normaldarstellung
Quellcodebibliothek Statistik Leitseite products/Sources/formale Sprachen/C/Linux/drivers/video/   (Open Source Betriebssystem Version 6.17.9©)  Datei vom 24.10.2025 mit Größe 13 kB image not shown  

Quelle  vgastate.c   Sprache: C

 
/*
 * linux/drivers/video/vgastate.c -- VGA state save/restore
 *
 * Copyright 2002 James Simmons
 *
 * Copyright history from vga16fb.c:
 * Copyright 1999 Ben Pfaff and Petr Vandrovec
 * Based on VGA info at http://www.goodnet.com/~tinara/FreeVGA/home.htm
 * Based on VESA framebuffer (c) 1998 Gerd Knorr
 *
 * 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/slab.h>
#include <linux/fb.h>
#include <linux/vmalloc.h>
#include <video/vga.h>

struct regstate {
 __u8 *vga_font0;
 __u8 *vga_font1;
 __u8 *vga_text;
 __u8 *vga_cmap;
 __u8 *attr;
 __u8 *crtc;
 __u8 *gfx;
 __u8 *seq;
 __u8 misc;
};

static inline unsigned char vga_rcrtcs(void __iomem *regbase, unsigned short iobase,
           unsigned char reg)
{
 vga_w(regbase, iobase + 0x4, reg);
 return vga_r(regbase, iobase + 0x5);
}

static inline void vga_wcrtcs(void __iomem *regbase, unsigned short iobase,
         unsigned char reg, unsigned char val)
{
 vga_w(regbase, iobase + 0x4, reg);
 vga_w(regbase, iobase + 0x5, val);
}

static void save_vga_text(struct vgastate *state, void __iomem *fbbase)
{
 struct regstate *saved = (struct regstate *) state->vidstate;
 int i;
 u8 misc, attr10, gr4, gr5, gr6, seq1, seq2, seq4;
 unsigned short iobase;

 /* if in graphics mode, no need to save */
 misc = vga_r(state->vgabase, VGA_MIS_R);
 iobase = (misc & 1) ? 0x3d0 : 0x3b0;

 vga_r(state->vgabase, iobase + 0xa);
 vga_w(state->vgabase, VGA_ATT_W, 0x00);
 attr10 = vga_rattr(state->vgabase, 0x10);
 vga_r(state->vgabase, iobase + 0xa);
 vga_w(state->vgabase, VGA_ATT_W, 0x20);

 if (attr10 & 1)
  return;

 /* save regs */
 gr4 = vga_rgfx(state->vgabase, VGA_GFX_PLANE_READ);
 gr5 = vga_rgfx(state->vgabase, VGA_GFX_MODE);
 gr6 = vga_rgfx(state->vgabase, VGA_GFX_MISC);
 seq2 = vga_rseq(state->vgabase, VGA_SEQ_PLANE_WRITE);
 seq4 = vga_rseq(state->vgabase, VGA_SEQ_MEMORY_MODE);

 /* blank screen */
 seq1 = vga_rseq(state->vgabase, VGA_SEQ_CLOCK_MODE);
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 | 1 << 5);
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);

 /* save font at plane 2 */
 if (state->flags & VGA_SAVE_FONT0) {
  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x4);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x2);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < 4 * 8192; i++)
   saved->vga_font0[i] = vga_r(fbbase, i);
 }

 /* save font at plane 3 */
 if (state->flags & VGA_SAVE_FONT1) {
  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x8);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x3);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < state->memsize; i++)
   saved->vga_font1[i] = vga_r(fbbase, i);
 }

 /* save font at plane 0/1 */
 if (state->flags & VGA_SAVE_TEXT) {
  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x1);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < 8192; i++)
   saved->vga_text[i] = vga_r(fbbase, i);

  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x2);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x1);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < 8192; i++)
   saved->vga_text[8192+i] = vga_r(fbbase + 2 * 8192, i);
 }

 /* restore regs */
 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, seq2);
 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, seq4);

 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, gr4);
 vga_wgfx(state->vgabase, VGA_GFX_MODE, gr5);
 vga_wgfx(state->vgabase, VGA_GFX_MISC, gr6);

 /* unblank screen */
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 & ~(1 << 5));
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);

 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1);
}

static void restore_vga_text(struct vgastate *state, void __iomem *fbbase)
{
 struct regstate *saved = (struct regstate *) state->vidstate;
 int i;
 u8 gr1, gr3, gr4, gr5, gr6, gr8;
 u8 seq1, seq2, seq4;

 /* save regs */
 gr1 = vga_rgfx(state->vgabase, VGA_GFX_SR_ENABLE);
 gr3 = vga_rgfx(state->vgabase, VGA_GFX_DATA_ROTATE);
 gr4 = vga_rgfx(state->vgabase, VGA_GFX_PLANE_READ);
 gr5 = vga_rgfx(state->vgabase, VGA_GFX_MODE);
 gr6 = vga_rgfx(state->vgabase, VGA_GFX_MISC);
 gr8 = vga_rgfx(state->vgabase, VGA_GFX_BIT_MASK);
 seq2 = vga_rseq(state->vgabase, VGA_SEQ_PLANE_WRITE);
 seq4 = vga_rseq(state->vgabase, VGA_SEQ_MEMORY_MODE);

 /* blank screen */
 seq1 = vga_rseq(state->vgabase, VGA_SEQ_CLOCK_MODE);
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 | 1 << 5);
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);

 if (state->depth == 4) {
  vga_wgfx(state->vgabase, VGA_GFX_DATA_ROTATE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_BIT_MASK, 0xff);
  vga_wgfx(state->vgabase, VGA_GFX_SR_ENABLE, 0x00);
 }

 /* restore font at plane 2 */
 if (state->flags & VGA_SAVE_FONT0) {
  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x4);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x2);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < 4 * 8192; i++)
   vga_w(fbbase, i, saved->vga_font0[i]);
 }

 /* restore font at plane 3 */
 if (state->flags & VGA_SAVE_FONT1) {
  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x8);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x3);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < state->memsize; i++)
   vga_w(fbbase, i, saved->vga_font1[i]);
 }

 /* restore font at plane 0/1 */
 if (state->flags & VGA_SAVE_TEXT) {
  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x1);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < 8192; i++)
   vga_w(fbbase, i, saved->vga_text[i]);

  vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, 0x2);
  vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, 0x6);
  vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, 0x1);
  vga_wgfx(state->vgabase, VGA_GFX_MODE, 0x0);
  vga_wgfx(state->vgabase, VGA_GFX_MISC, 0x5);
  for (i = 0; i < 8192; i++)
   vga_w(fbbase, i, saved->vga_text[8192+i]);
 }

 /* unblank screen */
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x1);
 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1 & ~(1 << 5));
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x3);

 /* restore regs */
 vga_wgfx(state->vgabase, VGA_GFX_SR_ENABLE, gr1);
 vga_wgfx(state->vgabase, VGA_GFX_DATA_ROTATE, gr3);
 vga_wgfx(state->vgabase, VGA_GFX_PLANE_READ, gr4);
 vga_wgfx(state->vgabase, VGA_GFX_MODE, gr5);
 vga_wgfx(state->vgabase, VGA_GFX_MISC, gr6);
 vga_wgfx(state->vgabase, VGA_GFX_BIT_MASK, gr8);

 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE, seq1);
 vga_wseq(state->vgabase, VGA_SEQ_PLANE_WRITE, seq2);
 vga_wseq(state->vgabase, VGA_SEQ_MEMORY_MODE, seq4);
}

static void save_vga_mode(struct vgastate *state)
{
 struct regstate *saved = (struct regstate *) state->vidstate;
 unsigned short iobase;
 int i;

 saved->misc = vga_r(state->vgabase, VGA_MIS_R);
 if (saved->misc & 1)
  iobase = 0x3d0;
 else
  iobase = 0x3b0;

 for (i = 0; i < state->num_crtc; i++)
  saved->crtc[i] = vga_rcrtcs(state->vgabase, iobase, i);

 vga_r(state->vgabase, iobase + 0xa);
 vga_w(state->vgabase, VGA_ATT_W, 0x00);
 for (i = 0; i < state->num_attr; i++) {
  vga_r(state->vgabase, iobase + 0xa);
  saved->attr[i] = vga_rattr(state->vgabase, i);
 }
 vga_r(state->vgabase, iobase + 0xa);
 vga_w(state->vgabase, VGA_ATT_W, 0x20);

 for (i = 0; i < state->num_gfx; i++)
  saved->gfx[i] = vga_rgfx(state->vgabase, i);

 for (i = 0; i < state->num_seq; i++)
  saved->seq[i] = vga_rseq(state->vgabase, i);
}

static void restore_vga_mode(struct vgastate *state)
{
 struct regstate *saved = (struct regstate *) state->vidstate;
 unsigned short iobase;
 int i;

 vga_w(state->vgabase, VGA_MIS_W, saved->misc);

 if (saved->misc & 1)
  iobase = 0x3d0;
 else
  iobase = 0x3b0;

 /* turn off display */
 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE,
   saved->seq[VGA_SEQ_CLOCK_MODE] | 0x20);

 /* disable sequencer */
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x01);

 /* enable palette addressing */
 vga_r(state->vgabase, iobase + 0xa);
 vga_w(state->vgabase, VGA_ATT_W, 0x00);

 for (i = 2; i < state->num_seq; i++)
  vga_wseq(state->vgabase, i, saved->seq[i]);


 /* unprotect vga regs */
 vga_wcrtcs(state->vgabase, iobase, 17, saved->crtc[17] & ~0x80);
 for (i = 0; i < state->num_crtc; i++)
  vga_wcrtcs(state->vgabase, iobase, i, saved->crtc[i]);

 for (i = 0; i < state->num_gfx; i++)
  vga_wgfx(state->vgabase, i, saved->gfx[i]);

 for (i = 0; i < state->num_attr; i++) {
  vga_r(state->vgabase, iobase + 0xa);
  vga_wattr(state->vgabase, i, saved->attr[i]);
 }

 /* reenable sequencer */
 vga_wseq(state->vgabase, VGA_SEQ_RESET, 0x03);
 /* turn display on */
 vga_wseq(state->vgabase, VGA_SEQ_CLOCK_MODE,
   saved->seq[VGA_SEQ_CLOCK_MODE] & ~(1 << 5));

 /* disable video/palette source */
 vga_r(state->vgabase, iobase + 0xa);
 vga_w(state->vgabase, VGA_ATT_W, 0x20);
}

static void save_vga_cmap(struct vgastate *state)
{
 struct regstate *saved = (struct regstate *) state->vidstate;
 int i;

 vga_w(state->vgabase, VGA_PEL_MSK, 0xff);

 /* assumes DAC is readable and writable */
 vga_w(state->vgabase, VGA_PEL_IR, 0x00);
 for (i = 0; i < 768; i++)
  saved->vga_cmap[i] = vga_r(state->vgabase, VGA_PEL_D);
}

static void restore_vga_cmap(struct vgastate *state)
{
 struct regstate *saved = (struct regstate *) state->vidstate;
 int i;

 vga_w(state->vgabase, VGA_PEL_MSK, 0xff);

 /* assumes DAC is readable and writable */
 vga_w(state->vgabase, VGA_PEL_IW, 0x00);
 for (i = 0; i < 768; i++)
  vga_w(state->vgabase, VGA_PEL_D, saved->vga_cmap[i]);
}

static void vga_cleanup(struct vgastate *state)
{
 if (state->vidstate != NULL) {
  struct regstate *saved = (struct regstate *) state->vidstate;

  vfree(saved->vga_font0);
  vfree(saved->vga_font1);
  vfree(saved->vga_text);
  vfree(saved->vga_cmap);
  vfree(saved->attr);
  kfree(saved);
  state->vidstate = NULL;
 }
}

int save_vga(struct vgastate *state)
{
 struct regstate *saved;

 saved = kzalloc(sizeof(struct regstate), GFP_KERNEL);

 if (saved == NULL)
  return 1;

 state->vidstate = (void *)saved;

 if (state->flags & VGA_SAVE_CMAP) {
  saved->vga_cmap = vmalloc(768);
  if (!saved->vga_cmap) {
   vga_cleanup(state);
   return 1;
  }
  save_vga_cmap(state);
 }

 if (state->flags & VGA_SAVE_MODE) {
  int total;

  if (state->num_attr < 21)
   state->num_attr = 21;
  if (state->num_crtc < 25)
   state->num_crtc = 25;
  if (state->num_gfx < 9)
   state->num_gfx = 9;
  if (state->num_seq < 5)
   state->num_seq = 5;
  total = state->num_attr + state->num_crtc +
   state->num_gfx + state->num_seq;

  saved->attr = vmalloc(total);
  if (!saved->attr) {
   vga_cleanup(state);
   return 1;
  }
  saved->crtc = saved->attr + state->num_attr;
  saved->gfx = saved->crtc + state->num_crtc;
  saved->seq = saved->gfx + state->num_gfx;

  save_vga_mode(state);
 }

 if (state->flags & VGA_SAVE_FONTS) {
  void __iomem *fbbase;

  /* exit if window is less than 32K */
  if (state->memsize && state->memsize < 4 * 8192) {
   vga_cleanup(state);
   return 1;
  }
  if (!state->memsize)
   state->memsize = 8 * 8192;

  if (!state->membase)
   state->membase = 0xA0000;

  fbbase = ioremap(state->membase, state->memsize);

  if (!fbbase) {
   vga_cleanup(state);
   return 1;
  }

  /*
 * save only first 32K used by vgacon
 */
  if (state->flags & VGA_SAVE_FONT0) {
   saved->vga_font0 = vmalloc(4 * 8192);
   if (!saved->vga_font0) {
    iounmap(fbbase);
    vga_cleanup(state);
    return 1;
   }
  }
  /*
 * largely unused, but if required by the caller
 * we'll just save everything.
 */
  if (state->flags & VGA_SAVE_FONT1) {
   saved->vga_font1 = vmalloc(state->memsize);
   if (!saved->vga_font1) {
    iounmap(fbbase);
    vga_cleanup(state);
    return 1;
   }
  }
  /*
 * Save 8K at plane0[0], and 8K at plane1[16K]
 */
  if (state->flags & VGA_SAVE_TEXT) {
   saved->vga_text = vmalloc(8192 * 2);
   if (!saved->vga_text) {
    iounmap(fbbase);
    vga_cleanup(state);
    return 1;
   }
  }

  save_vga_text(state, fbbase);
  iounmap(fbbase);
 }
 return 0;
}

int restore_vga(struct vgastate *state)
{
 if (state->vidstate == NULL)
  return 1;

 if (state->flags & VGA_SAVE_MODE)
  restore_vga_mode(state);

 if (state->flags & VGA_SAVE_FONTS) {
  void __iomem *fbbase = ioremap(state->membase, state->memsize);

  if (!fbbase) {
   vga_cleanup(state);
   return 1;
  }
  restore_vga_text(state, fbbase);
  iounmap(fbbase);
 }

 if (state->flags & VGA_SAVE_CMAP)
  restore_vga_cmap(state);

 vga_cleanup(state);
 return 0;
}

EXPORT_SYMBOL(save_vga);
EXPORT_SYMBOL(restore_vga);

MODULE_AUTHOR("James Simmons ");
MODULE_DESCRIPTION("VGA State Save/Restore");
MODULE_LICENSE("GPL");


Messung V0.5
C=91 H=94 G=92

¤ Dauer der Verarbeitung: 0.1 Sekunden  (vorverarbeitet)  ¤

*© Formatika GbR, Deutschland




Wurzel

Suchen

Beweissystem der NASA

Beweissystem Isabelle

NIST Cobol Testsuite

Cephes Mathematical Library

Wiener Entwicklungsmethode

Haftungshinweis

Die Informationen auf dieser Webseite wurden nach bestem Wissen sorgfältig zusammengestellt. Es wird jedoch weder Vollständigkeit, noch Richtigkeit, noch Qualität der bereit gestellten Informationen zugesichert.

Bemerkung:

Die farbliche Syntaxdarstellung und die Messung sind noch experimentell.