svn commit: r279487 - head/sys/dev/pci

[Jean-Sebastien Pedron]

Author: dumbbell
Date: Sun Mar  1 12:47:36 2015
New Revision: 279487
URL: https://svnweb.freebsd.org/changeset/base/279487

Log:
  vgapci: New vga_pci_repost() function
  
  This can be used to restore the VGA mode after a KMS driver is unloaded.
  
  Differential Revision:        https://reviews.freebsd.org/D687

Modified:
  head/sys/dev/pci/pcivar.h
  head/sys/dev/pci/vga_pci.c

Modified: head/sys/dev/pci/pcivar.h
==============================================================================
--- head/sys/dev/pci/pcivar.h   Sun Mar  1 10:39:19 2015        (r279486)
+++ head/sys/dev/pci/pcivar.h   Sun Mar  1 12:47:36 2015        (r279487)
@@ -591,5 +591,6 @@ struct pcicfg_vpd *pci_fetch_vpd_list(de
 int    vga_pci_is_boot_display(device_t dev);
 void * vga_pci_map_bios(device_t dev, size_t *size);
 void   vga_pci_unmap_bios(device_t dev, void *bios);
+int    vga_pci_repost(device_t dev);
 
 #endif /* _PCIVAR_H_ */

Modified: head/sys/dev/pci/vga_pci.c
==============================================================================
--- head/sys/dev/pci/vga_pci.c  Sun Mar  1 10:39:19 2015        (r279486)
+++ head/sys/dev/pci/vga_pci.c  Sun Mar  1 12:47:36 2015        (r279487)
@@ -51,6 +51,8 @@ __FBSDID("$FreeBSD$");
 #include <dev/pci/pcireg.h>
 #include <dev/pci/pcivar.h>
 
+#include <compat/x86bios/x86bios.h> /* To re-POST the card. */
+
 struct vga_resource {
        struct resource *vr_res;
        int     vr_refs;
@@ -194,6 +196,36 @@ vga_pci_unmap_bios(device_t dev, void *b
            vr->vr_res);
 }
 
+int
+vga_pci_repost(device_t dev)
+{
+#if defined(__amd64__) || defined(__i386__)
+       x86regs_t regs;
+
+       if (!vga_pci_is_boot_display(dev))
+               return (EINVAL);
+
+       if (x86bios_get_orm(VGA_PCI_BIOS_SHADOW_ADDR) == NULL)
+               return (ENOTSUP);
+
+       x86bios_init_regs(&regs);
+
+       regs.R_AH = pci_get_bus(dev);
+       regs.R_AL = (pci_get_slot(dev) << 3) | (pci_get_function(dev) & 0x07);
+       regs.R_DL = 0x80;
+
+       device_printf(dev, "REPOSTing\n");
+       x86bios_call(&regs, X86BIOS_PHYSTOSEG(VGA_PCI_BIOS_SHADOW_ADDR + 3),
+           X86BIOS_PHYSTOOFF(VGA_PCI_BIOS_SHADOW_ADDR + 3));
+
+       x86bios_get_intr(0x10);
+
+       return (0);
+#else
+       return (ENOTSUP);
+#endif
+}
+
 static int
 vga_pci_probe(device_t dev)
 {
_______________________________________________
svn-src-all@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-all
To unsubscribe, send any mail to "svn-src-all-unsubscr...@freebsd.org"