Save/restore VGA state from vga_pci.c instead of relying on vga_isa.c.

It was not working because we were saving its state after the device was
powered down.  Simplify vesa_load_state() as the culprit is fixed now.
This commit is contained in:
Jung-uk Kim 2009-11-05 22:58:50 +00:00
parent 663c61a35b
commit 2259d74c68
Notes: svn2git 2020-12-20 02:59:44 +00:00
svn path=/head/; revision=198964
3 changed files with 104 additions and 71 deletions

View File

@ -164,7 +164,6 @@ static char *vesa_revstr = NULL;
static int int10_set_mode(int mode);
static int vesa_bios_post(void);
static int vesa_bios_get_mode(int mode, struct vesa_mode *vmode);
static int vesa_bios_get_current_mode(void);
static int vesa_bios_set_mode(int mode);
static int vesa_bios_get_dac(void);
static int vesa_bios_set_dac(int bits);
@ -318,22 +317,6 @@ vesa_bios_get_mode(int mode, struct vesa_mode *vmode)
return (0);
}
static int
vesa_bios_get_current_mode(void)
{
x86regs_t regs;
x86bios_init_regs(&regs);
regs.R_AX = 0x4f03;
x86bios_intr(&regs, 0x10);
if (regs.R_AX != 0x004f)
return (-1);
return (regs.R_BX);
}
static int
vesa_bios_set_mode(int mode)
{
@ -1438,7 +1421,6 @@ vesa_save_state(video_adapter_t *adp, void *p, size_t size)
static int
vesa_load_state(video_adapter_t *adp, void *p)
{
int flags, mode, ret;
if ((adp != vesa_adp) || (((adp_state_t *)p)->sig != V_STATE_SIG))
return ((*prevvidsw->load_state)(adp, p));
@ -1446,38 +1428,12 @@ vesa_load_state(video_adapter_t *adp, void *p)
if (vesa_state_buf_size <= 0)
return (1);
/*
* If the current mode is not the same, probably it was powered down.
* Try BIOS POST to restore a sane state.
*/
if (VESA_MODE(adp->va_mode)) {
mode = vesa_bios_get_current_mode();
if (mode >= 0 && (mode & 0x1ff) != adp->va_mode)
(void)vesa_bios_post();
}
/* Try BIOS POST to restore a sane state. */
(void)vesa_bios_post();
(void)int10_set_mode(adp->va_initial_bios_mode);
ret = vesa_bios_save_restore(STATE_LOAD, ((adp_state_t *)p)->regs,
vesa_state_buf_size);
/*
* If the desired mode is not restored, force setting the mode.
*/
if (VESA_MODE(adp->va_mode)) {
mode = vesa_bios_get_current_mode();
if (mode < 0 || (mode & 0x1ff) == adp->va_mode)
return (ret);
mode = adp->va_mode;
flags = adp->va_info.vi_flags;
if ((flags & V_INFO_GRAPHICS) != 0 &&
(flags & V_INFO_LINEAR) != 0)
mode |= 0x4000;
(void)vesa_bios_set_mode(mode);
if ((vesa_adp_info->v_flags & V_DAC8) != 0)
(void)vesa_bios_set_dac(8);
(void)(*vidsw[adp->va_index]->set_hw_cursor)(adp, -1, -1);
}
return (ret);
return (vesa_bios_save_restore(STATE_LOAD, ((adp_state_t *)p)->regs,
vesa_state_buf_size));
}
#if 0

View File

@ -40,12 +40,17 @@ __FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/fbio.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/rman.h>
#include <sys/sysctl.h>
#include <sys/systm.h>
#include <dev/fb/fbreg.h>
#include <dev/fb/vgareg.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
@ -63,7 +68,7 @@ SYSCTL_DECL(_hw_pci);
int vga_pci_default_unit = -1;
TUNABLE_INT("hw.pci.default_vgapci_unit", &vga_pci_default_unit);
SYSCTL_INT(_hw_pci, OID_AUTO, default_vgapci_unit, CTLFLAG_RD,
SYSCTL_INT(_hw_pci, OID_AUTO, default_vgapci_unit, CTLFLAG_RDTUN,
&vga_pci_default_unit, -1, "Default VGA-compatible display");
static int
@ -112,13 +117,86 @@ vga_pci_attach(device_t dev)
static int
vga_pci_suspend(device_t dev)
{
vga_softc_t *sc;
devclass_t dc;
int err, nbytes;
return (bus_generic_suspend(dev));
err = bus_generic_suspend(dev);
if (err)
return (err);
sc = NULL;
if (device_get_unit(dev) == vga_pci_default_unit) {
dc = devclass_find(VGA_DRIVER_NAME);
if (dc != NULL)
sc = devclass_get_softc(dc, 0);
}
if (sc == NULL)
return (0);
/* Save the video state across the suspend. */
if (sc->state_buf != NULL)
goto save_palette;
nbytes = vidd_save_state(sc->adp, NULL, 0);
if (nbytes <= 0)
goto save_palette;
sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT);
if (sc->state_buf == NULL)
goto save_palette;
if (bootverbose)
device_printf(dev, "saving %d bytes of video state\n", nbytes);
if (vidd_save_state(sc->adp, sc->state_buf, nbytes) != 0) {
device_printf(dev, "failed to save state (nbytes=%d)\n",
nbytes);
free(sc->state_buf, M_TEMP);
sc->state_buf = NULL;
}
save_palette:
/* Save the color palette across the suspend. */
if (sc->pal_buf != NULL)
return (0);
sc->pal_buf = malloc(256 * 3, M_TEMP, M_NOWAIT);
if (sc->pal_buf != NULL) {
if (bootverbose)
device_printf(dev, "saving color palette\n");
if (vidd_save_palette(sc->adp, sc->pal_buf) != 0) {
device_printf(dev, "failed to save palette\n");
free(sc->pal_buf, M_TEMP);
sc->pal_buf = NULL;
}
}
return (0);
}
static int
vga_pci_resume(device_t dev)
{
vga_softc_t *sc;
devclass_t dc;
sc = NULL;
if (device_get_unit(dev) == vga_pci_default_unit) {
dc = devclass_find(VGA_DRIVER_NAME);
if (dc != NULL)
sc = devclass_get_softc(dc, 0);
}
if (sc == NULL)
return (bus_generic_resume(dev));
if (sc->state_buf != NULL) {
if (vidd_load_state(sc->adp, sc->state_buf) != 0)
device_printf(dev, "failed to reload state\n");
free(sc->state_buf, M_TEMP);
sc->state_buf = NULL;
}
if (sc->pal_buf != NULL) {
if (vidd_load_palette(sc->adp, sc->pal_buf) != 0)
device_printf(dev, "failed to reload palette\n");
free(sc->pal_buf, M_TEMP);
sc->pal_buf = NULL;
}
return (bus_generic_resume(dev));
}

View File

@ -166,35 +166,34 @@ isavga_suspend(device_t dev)
vga_softc_t *sc;
int err, nbytes;
sc = device_get_softc(dev);
err = bus_generic_suspend(dev);
if (err)
return (err);
sc = device_get_softc(dev);
/* Save the video state across the suspend. */
if (sc->state_buf != NULL) {
if (sc->state_buf != NULL)
goto save_palette;
nbytes = vidd_save_state(sc->adp, NULL, 0);
if (nbytes <= 0)
goto save_palette;
sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT);
if (sc->state_buf == NULL)
goto save_palette;
if (bootverbose)
device_printf(dev, "saving %d bytes of video state\n", nbytes);
if (vidd_save_state(sc->adp, sc->state_buf, nbytes) != 0) {
device_printf(dev, "failed to save state (nbytes=%d)\n",
nbytes);
free(sc->state_buf, M_TEMP);
sc->state_buf = NULL;
}
nbytes = vidd_save_state(sc->adp, NULL, 0);
if (nbytes <= 0)
return (0);
sc->state_buf = malloc(nbytes, M_TEMP, M_NOWAIT);
if (sc->state_buf != NULL) {
if (bootverbose)
device_printf(dev, "saving %d bytes of video state\n",
nbytes);
if (vidd_save_state(sc->adp, sc->state_buf, nbytes) != 0) {
device_printf(dev, "failed to save state (nbytes=%d)\n",
nbytes);
free(sc->state_buf, M_TEMP);
sc->state_buf = NULL;
}
}
save_palette:
/* Save the color palette across the suspend. */
if (sc->pal_buf != NULL)
free(sc->pal_buf, M_TEMP);
return (0);
sc->pal_buf = malloc(256 * 3, M_TEMP, M_NOWAIT);
if (sc->pal_buf != NULL) {
if (bootverbose)
@ -215,6 +214,7 @@ isavga_resume(device_t dev)
vga_softc_t *sc;
sc = device_get_softc(dev);
if (sc->state_buf != NULL) {
if (vidd_load_state(sc->adp, sc->state_buf) != 0)
device_printf(dev, "failed to reload state\n");
@ -228,8 +228,7 @@ isavga_resume(device_t dev)
sc->pal_buf = NULL;
}
bus_generic_resume(dev);
return 0;
return (bus_generic_resume(dev));
}
#ifdef FB_INSTALL_CDEV