diff options
Diffstat (limited to 'sys/dev/agp/agp_sis.c')
| -rw-r--r-- | sys/dev/agp/agp_sis.c | 263 |
1 files changed, 263 insertions, 0 deletions
diff --git a/sys/dev/agp/agp_sis.c b/sys/dev/agp/agp_sis.c new file mode 100644 index 0000000..aecbb3f --- /dev/null +++ b/sys/dev/agp/agp_sis.c @@ -0,0 +1,263 @@ +/*- + * Copyright (c) 2000 Doug Rabson + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include <sys/cdefs.h> +__FBSDID("$FreeBSD$"); + +#include "opt_bus.h" + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/malloc.h> +#include <sys/kernel.h> +#include <sys/bus.h> +#include <sys/lock.h> +#include <sys/lockmgr.h> +#include <sys/mutex.h> +#include <sys/proc.h> + +#include <pci/pcivar.h> +#include <pci/pcireg.h> +#include <pci/agppriv.h> +#include <pci/agpreg.h> + +#include <vm/vm.h> +#include <vm/vm_object.h> +#include <vm/pmap.h> + +struct agp_sis_softc { + struct agp_softc agp; + u_int32_t initial_aperture; /* aperture size at startup */ + struct agp_gatt *gatt; +}; + +static const char* +agp_sis_match(device_t dev) +{ + if (pci_get_class(dev) != PCIC_BRIDGE + || pci_get_subclass(dev) != PCIS_BRIDGE_HOST) + return NULL; + + if (agp_find_caps(dev) == 0) + return NULL; + + switch (pci_get_devid(dev)) { + case 0x00011039: + return ("SiS 5591 host to AGP bridge"); + case 0x06481039: + return ("SiS 648 host to AGP bridge"); + }; + + if (pci_get_vendor(dev) == 0x1039) + return ("SIS Generic host to PCI bridge"); + + return NULL; +} + +static int +agp_sis_probe(device_t dev) +{ + const char *desc; + + desc = agp_sis_match(dev); + if (desc) { + device_verbose(dev); + device_set_desc(dev, desc); + return 0; + } + + return ENXIO; +} + +static int +agp_sis_attach(device_t dev) +{ + struct agp_sis_softc *sc = device_get_softc(dev); + struct agp_gatt *gatt; + int error; + + error = agp_generic_attach(dev); + if (error) + return error; + + sc->initial_aperture = AGP_GET_APERTURE(dev); + + for (;;) { + gatt = agp_alloc_gatt(dev); + if (gatt) + break; + + /* + * Probably contigmalloc failure. Try reducing the + * aperture so that the gatt size reduces. + */ + if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) { + agp_generic_detach(dev); + return ENOMEM; + } + } + sc->gatt = gatt; + + /* Install the gatt. */ + pci_write_config(dev, AGP_SIS_ATTBASE, gatt->ag_physical, 4); + + /* Enable the aperture. */ + pci_write_config(dev, AGP_SIS_WINCTRL, + pci_read_config(dev, AGP_SIS_WINCTRL, 1) | 3, 1); + + /* + * Enable the TLB and make it automatically invalidate entries + * when the GATT is written. + */ + pci_write_config(dev, AGP_SIS_TLBCTRL, 0x05, 1); + + return 0; +} + +static int +agp_sis_detach(device_t dev) +{ + struct agp_sis_softc *sc = device_get_softc(dev); + int error; + + error = agp_generic_detach(dev); + if (error) + return error; + + /* Disable the aperture.. */ + pci_write_config(dev, AGP_SIS_WINCTRL, + pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~3, 1); + + /* and the TLB. */ + pci_write_config(dev, AGP_SIS_TLBCTRL, 0, 1); + + /* Put the aperture back the way it started. */ + AGP_SET_APERTURE(dev, sc->initial_aperture); + + agp_free_gatt(sc->gatt); + return 0; +} + +static u_int32_t +agp_sis_get_aperture(device_t dev) +{ + int gws; + + /* + * The aperture size is equal to 4M<<gws. + */ + gws = (pci_read_config(dev, AGP_SIS_WINCTRL, 1) & 0x70) >> 4; + return (4*1024*1024) << gws; +} + +static int +agp_sis_set_aperture(device_t dev, u_int32_t aperture) +{ + int gws; + + /* + * Check for a power of two and make sure its within the + * programmable range. + */ + if (aperture & (aperture - 1) + || aperture < 4*1024*1024 + || aperture > 256*1024*1024) + return EINVAL; + + gws = ffs(aperture / 4*1024*1024) - 1; + + pci_write_config(dev, AGP_SIS_WINCTRL, + ((pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~0x70) + | gws << 4), 1); + + return 0; +} + +static int +agp_sis_bind_page(device_t dev, int offset, vm_offset_t physical) +{ + struct agp_sis_softc *sc = device_get_softc(dev); + + if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) + return EINVAL; + + sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical; + return 0; +} + +static int +agp_sis_unbind_page(device_t dev, int offset) +{ + struct agp_sis_softc *sc = device_get_softc(dev); + + if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) + return EINVAL; + + sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0; + return 0; +} + +static void +agp_sis_flush_tlb(device_t dev) +{ + pci_write_config(dev, AGP_SIS_TLBFLUSH, 0x02, 1); +} + +static device_method_t agp_sis_methods[] = { + /* Device interface */ + DEVMETHOD(device_probe, agp_sis_probe), + DEVMETHOD(device_attach, agp_sis_attach), + DEVMETHOD(device_detach, agp_sis_detach), + DEVMETHOD(device_shutdown, bus_generic_shutdown), + DEVMETHOD(device_suspend, bus_generic_suspend), + DEVMETHOD(device_resume, bus_generic_resume), + + /* AGP interface */ + DEVMETHOD(agp_get_aperture, agp_sis_get_aperture), + DEVMETHOD(agp_set_aperture, agp_sis_set_aperture), + DEVMETHOD(agp_bind_page, agp_sis_bind_page), + DEVMETHOD(agp_unbind_page, agp_sis_unbind_page), + DEVMETHOD(agp_flush_tlb, agp_sis_flush_tlb), + DEVMETHOD(agp_enable, agp_generic_enable), + DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory), + DEVMETHOD(agp_free_memory, agp_generic_free_memory), + DEVMETHOD(agp_bind_memory, agp_generic_bind_memory), + DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory), + + { 0, 0 } +}; + +static driver_t agp_sis_driver = { + "agp", + agp_sis_methods, + sizeof(struct agp_sis_softc), +}; + +static devclass_t agp_devclass; + +DRIVER_MODULE(agp_sis, pci, agp_sis_driver, agp_devclass, 0, 0); +MODULE_DEPEND(agp_sis, agp, 1, 1, 1); +MODULE_DEPEND(agp_sis, pci, 1, 1, 1); |
