#include "vga.h"
#if defined(__i386__) || defined(__amd64__)
#include "acpi.h"
#endif
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <machine/bus.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/pcidevs.h>
#include <dev/ic/mc6845reg.h>
#include <dev/ic/pcdisplayvar.h>
#include <dev/ic/vgareg.h>
#include <dev/pci/vga_pcivar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/ic/vgavar.h>
#ifdef X86EMU
#include <machine/vga_post.h>
#endif
int vga_pci_match(struct device *, void *, void *);
void vga_pci_attach(struct device *, struct device *, void *);
int vga_pci_activate(struct device *, int);
#if !defined(SMALL_KERNEL) && NACPI > 0
void vga_save_state(struct vga_pci_softc *);
void vga_restore_state(struct vga_pci_softc *);
#endif
const struct cfattach vga_pci_ca = {
sizeof(struct vga_pci_softc), vga_pci_match, vga_pci_attach,
NULL, vga_pci_activate
};
#if !defined(SMALL_KERNEL) && NACPI > 0
int vga_pci_do_post;
struct vga_device_description {
u_int16_t rval[4];
u_int16_t rmask[4];
char vga_pci_post;
};
static const struct vga_device_description vga_devs[] = {
{
{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_US15W_IGD,
0x0000, 0x0000 },
{ 0xffff, 0xffff, 0x0000, 0x0000 }, 1
},
{
{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_US15L_IGD,
0x0000, 0x0000 },
{ 0xffff, 0xffff, 0x0000, 0x0000 }, 1
},
{
{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_GMA600_0,
0x0000, 0x0000 },
{ 0xffff, 0xfff8, 0x0000, 0x0000 }, 1
},
{
{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_GMA600_8,
0x0000, 0x0000 },
{ 0xffff, 0xffff, 0x0000, 0x0000 }, 1
},
{
{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_MDFLD_IGD_0,
0x0000, 0x0000 },
{ 0xffff, 0xfff8, 0x0000, 0x0000 }, 1
},
{
{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_GMA3600_0,
0x0000, 0x0000 },
{ 0xffff, 0xfff0, 0x0000, 0x0000 }, 1
},
};
#endif
int
vga_pci_match(struct device *parent, void *match, void *aux)
{
struct pci_attach_args *pa = aux;
if (DEVICE_IS_VGA_PCI(pa->pa_class) == 0)
return (0);
if ((pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG)
& (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE))
!= (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE))
return (0);
if (vga_is_console(pa->pa_iot, WSDISPLAY_TYPE_PCIVGA))
return (1);
if (!vga_common_probe(pa->pa_iot, pa->pa_memt))
return (0);
return (1);
}
void
vga_pci_attach(struct device *parent, struct device *self, void *aux)
{
struct pci_attach_args *pa = aux;
pcireg_t reg;
struct vga_pci_softc *sc = (struct vga_pci_softc *)self;
#if !defined(SMALL_KERNEL) && NACPI > 0
int prod, vend, subid, subprod, subvend, i;
#endif
reg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
reg |= PCI_COMMAND_MASTER_ENABLE;
pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, reg);
sc->sc_type = WSDISPLAY_TYPE_PCIVGA;
printf("\n");
#if !defined(SMALL_KERNEL) && NACPI > 0
#ifdef X86EMU
if ((sc->sc_posth = vga_post_init(pa->pa_bus, pa->pa_device,
pa->pa_function)) == NULL)
printf("couldn't set up vga POST handler\n");
#endif
vend = PCI_VENDOR(pa->pa_id);
prod = PCI_PRODUCT(pa->pa_id);
subid = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG);
subvend = PCI_VENDOR(subid);
subprod = PCI_PRODUCT(subid);
for (i = 0; i < nitems(vga_devs); i++)
if ((vend & vga_devs[i].rmask[0]) == vga_devs[i].rval[0] &&
(prod & vga_devs[i].rmask[1]) == vga_devs[i].rval[1] &&
(subvend & vga_devs[i].rmask[2]) == vga_devs[i].rval[2] &&
(subprod & vga_devs[i].rmask[3]) == vga_devs[i].rval[3]) {
vga_pci_do_post = vga_devs[i].vga_pci_post;
break;
}
#endif
#ifdef RAMDISK_HOOKS
if (vga_aperture_needed(pa))
printf("%s: aperture needed\n", sc->sc_dev.dv_xname);
#endif
sc->sc_vc = vga_common_attach(self, pa->pa_iot, pa->pa_memt,
sc->sc_type);
}
int
vga_pci_activate(struct device *self, int act)
{
int rv = 0;
#if !defined(SMALL_KERNEL) && NACPI > 0
struct vga_pci_softc *sc = (struct vga_pci_softc *)self;
#endif
switch (act) {
case DVACT_SUSPEND:
rv = config_activate_children(self, act);
#if !defined(SMALL_KERNEL) && NACPI > 0
vga_save_state(sc);
#endif
break;
case DVACT_RESUME:
#if !defined(SMALL_KERNEL) && NACPI > 0
#if defined (X86EMU)
if (vga_pci_do_post)
vga_post_call(sc->sc_posth);
#endif
vga_restore_state(sc);
#endif
rv = config_activate_children(self, act);
break;
default:
rv = config_activate_children(self, act);
break;
}
return (rv);
}
int
vga_pci_cnattach(bus_space_tag_t iot, bus_space_tag_t memt,
pci_chipset_tag_t pc, int bus, int device, int function)
{
return (vga_cnattach(iot, memt, WSDISPLAY_TYPE_PCIVGA, 0));
}
int
vga_pci_ioctl(void *v, u_long cmd, caddr_t addr, int flag, struct proc *pb)
{
int error = 0;
switch (cmd) {
case WSDISPLAYIO_GETPARAM:
if (ws_get_param != NULL)
return (*ws_get_param)((struct wsdisplay_param *)addr);
else
error = ENOTTY;
break;
case WSDISPLAYIO_SETPARAM:
if (ws_set_param != NULL)
return (*ws_set_param)((struct wsdisplay_param *)addr);
else
error = ENOTTY;
break;
default:
error = ENOTTY;
}
return (error);
}
#if !defined(SMALL_KERNEL) && NACPI > 0
void
vga_save_state(struct vga_pci_softc *sc)
{
struct vga_config *vc = sc->sc_vc;
struct vga_handle *vh;
struct vgascreen *scr;
size_t i;
char *buf;
if (vc == NULL)
return;
vh = &vc->hdl;
vga_ts_write(vh, syncreset, 1);
buf = (char *)&sc->sc_save_ts;
*buf++ = 0;
for (i = 1; i < sizeof(sc->sc_save_ts); i++)
*buf++ = _vga_ts_read(vh, i);
vga_ts_write(vh, syncreset, 3);
sc->sc_save_ts.mode &= ~0x20;
sc->sc_save_ts.mode |= 0x80;
buf = (char *)&sc->sc_save_crtc;
for (i = 0; i < sizeof(sc->sc_save_crtc); i++)
*buf++ = _pcdisplay_6845_read(&vh->vh_ph, i);
buf = (char *)&sc->sc_save_atc;
for (i = 0; i < sizeof(sc->sc_save_atc); i++)
*buf++ = _vga_attr_read(vh, i);
buf = (char *)&sc->sc_save_gdc;
for (i = 0; i < sizeof(sc->sc_save_gdc); i++)
*buf++ = _vga_gdc_read(vh, i);
vga_save_palette(vc);
if (vga_pci_do_post) {
scr = vc->active;
if (scr != NULL && scr->pcs.active && scr->pcs.mem != NULL)
bus_space_read_region_2(vh->vh_memt, vh->vh_memh,
scr->pcs.dispoffset, scr->pcs.mem,
scr->pcs.type->ncols * scr->pcs.type->nrows);
}
}
void
vga_restore_state(struct vga_pci_softc *sc)
{
struct vga_config *vc = sc->sc_vc;
struct vga_handle *vh;
struct vgascreen *scr;
size_t i;
char *buf;
if (vc == NULL)
return;
vh = &vc->hdl;
vga_ts_write(vh, syncreset, 1);
buf = (char *)&sc->sc_save_ts + 1;
for (i = 1; i < sizeof(sc->sc_save_ts); i++)
_vga_ts_write(vh, i, *buf++);
vga_ts_write(vh, syncreset, 3);
vga_6845_write(vh, vsynce,
vga_6845_read(vh, vsynce) & ~0x80);
buf = (char *)&sc->sc_save_crtc;
for (i = 0; i < sizeof(sc->sc_save_crtc); i++)
_pcdisplay_6845_write(&vh->vh_ph, i, *buf++);
buf = (char *)&sc->sc_save_atc;
for (i = 0; i < sizeof(sc->sc_save_atc); i++)
_vga_attr_write(vh, i, *buf++);
buf = (char *)&sc->sc_save_gdc;
for (i = 0; i < sizeof(sc->sc_save_gdc); i++)
_vga_gdc_write(vh, i, *buf++);
vga_restore_fonts(vc);
vga_restore_palette(vc);
if (vga_pci_do_post) {
scr = vc->active;
if (scr != NULL && scr->pcs.active && scr->pcs.mem != NULL)
bus_space_write_region_2(vh->vh_memt, vh->vh_memh,
scr->pcs.dispoffset, scr->pcs.mem,
scr->pcs.type->ncols * scr->pcs.type->nrows);
}
}
#endif