xref: /freebsd/sys/dev/agp/agp_intel.c (revision 718cf2ccb9956613756ab15d7a0e28f2c8e91cab)
159747216SDoug Rabson /*-
2*718cf2ccSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3*718cf2ccSPedro F. Giffuni  *
459747216SDoug Rabson  * Copyright (c) 2000 Doug Rabson
559747216SDoug Rabson  * All rights reserved.
659747216SDoug Rabson  *
759747216SDoug Rabson  * Redistribution and use in source and binary forms, with or without
859747216SDoug Rabson  * modification, are permitted provided that the following conditions
959747216SDoug Rabson  * are met:
1059747216SDoug Rabson  * 1. Redistributions of source code must retain the above copyright
1159747216SDoug Rabson  *    notice, this list of conditions and the following disclaimer.
1259747216SDoug Rabson  * 2. Redistributions in binary form must reproduce the above copyright
1359747216SDoug Rabson  *    notice, this list of conditions and the following disclaimer in the
1459747216SDoug Rabson  *    documentation and/or other materials provided with the distribution.
1559747216SDoug Rabson  *
1659747216SDoug Rabson  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1759747216SDoug Rabson  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1859747216SDoug Rabson  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1959747216SDoug Rabson  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2059747216SDoug Rabson  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2159747216SDoug Rabson  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2259747216SDoug Rabson  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2359747216SDoug Rabson  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2459747216SDoug Rabson  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2559747216SDoug Rabson  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2659747216SDoug Rabson  * SUCH DAMAGE.
2759747216SDoug Rabson  */
2859747216SDoug Rabson 
29f4636c59SDavid E. O'Brien #include <sys/cdefs.h>
30f4636c59SDavid E. O'Brien __FBSDID("$FreeBSD$");
31f4636c59SDavid E. O'Brien 
3259747216SDoug Rabson #include <sys/param.h>
3359747216SDoug Rabson #include <sys/systm.h>
3459747216SDoug Rabson #include <sys/malloc.h>
3559747216SDoug Rabson #include <sys/kernel.h>
36f11d01c3SPoul-Henning Kamp #include <sys/module.h>
3759747216SDoug Rabson #include <sys/bus.h>
3859747216SDoug Rabson #include <sys/lock.h>
3923955314SAlfred Perlstein #include <sys/mutex.h>
4052b3919dSJohn Baldwin #include <sys/proc.h>
4159747216SDoug Rabson 
42dbac8ff4SJohn Baldwin #include <dev/agp/agppriv.h>
43dbac8ff4SJohn Baldwin #include <dev/agp/agpreg.h>
4419b7ffd1SWarner Losh #include <dev/pci/pcivar.h>
4519b7ffd1SWarner Losh #include <dev/pci/pcireg.h>
4659747216SDoug Rabson 
4759747216SDoug Rabson #include <vm/vm.h>
4859747216SDoug Rabson #include <vm/vm_object.h>
4959747216SDoug Rabson #include <vm/pmap.h>
5059747216SDoug Rabson 
514fb8dd97SJohn Baldwin #define	MAX_APSIZE	0x3f		/* 256 MB */
524fb8dd97SJohn Baldwin 
5359747216SDoug Rabson struct agp_intel_softc {
5459747216SDoug Rabson 	struct agp_softc agp;
5559747216SDoug Rabson 	u_int32_t	initial_aperture; /* aperture size at startup */
5659747216SDoug Rabson 	struct agp_gatt *gatt;
574fb8dd97SJohn Baldwin 	u_int		aperture_mask;
58230a9294STakanori Watanabe 	u_int32_t	current_aperture; /* current aperture size */
5959747216SDoug Rabson };
6059747216SDoug Rabson 
6159747216SDoug Rabson static const char*
6259747216SDoug Rabson agp_intel_match(device_t dev)
6359747216SDoug Rabson {
6459747216SDoug Rabson 	if (pci_get_class(dev) != PCIC_BRIDGE
6559747216SDoug Rabson 	    || pci_get_subclass(dev) != PCIS_BRIDGE_HOST)
66ea9b97d2SJung-uk Kim 		return (NULL);
6759747216SDoug Rabson 
6859747216SDoug Rabson 	if (agp_find_caps(dev) == 0)
69ea9b97d2SJung-uk Kim 		return (NULL);
7059747216SDoug Rabson 
7159747216SDoug Rabson 	switch (pci_get_devid(dev)) {
7259747216SDoug Rabson 	/* Intel -- vendor 0x8086 */
7359747216SDoug Rabson 	case 0x71808086:
7459747216SDoug Rabson 		return ("Intel 82443LX (440 LX) host to PCI bridge");
7559747216SDoug Rabson 	case 0x71908086:
7659747216SDoug Rabson 		return ("Intel 82443BX (440 BX) host to PCI bridge");
7759747216SDoug Rabson  	case 0x71a08086:
7859747216SDoug Rabson  		return ("Intel 82443GX host to PCI bridge");
7959747216SDoug Rabson  	case 0x71a18086:
8059747216SDoug Rabson  		return ("Intel 82443GX host to AGP bridge");
8153dc09a8SKonstantin Belousov 	case 0x11308086:
8253dc09a8SKonstantin Belousov 		return ("Intel 82815 (i815 GMCH) host to PCI bridge");
8353dc09a8SKonstantin Belousov 	case 0x25008086:
8453dc09a8SKonstantin Belousov 	case 0x25018086:
8553dc09a8SKonstantin Belousov 		return ("Intel 82820 host to AGP bridge");
8653dc09a8SKonstantin Belousov 	case 0x35758086:
8753dc09a8SKonstantin Belousov 		return ("Intel 82830 host to AGP bridge");
8853dc09a8SKonstantin Belousov 	case 0x1a218086:
8953dc09a8SKonstantin Belousov 		return ("Intel 82840 host to AGP bridge");
9053dc09a8SKonstantin Belousov 	case 0x1a308086:
9153dc09a8SKonstantin Belousov 		return ("Intel 82845 host to AGP bridge");
9253dc09a8SKonstantin Belousov 	case 0x25308086:
9353dc09a8SKonstantin Belousov 		return ("Intel 82850 host to AGP bridge");
9453dc09a8SKonstantin Belousov 	case 0x33408086:
9553dc09a8SKonstantin Belousov 		return ("Intel 82855 host to AGP bridge");
9653dc09a8SKonstantin Belousov 	case 0x25318086:
9753dc09a8SKonstantin Belousov 		return ("Intel 82860 host to AGP bridge");
9853dc09a8SKonstantin Belousov 	case 0x25708086:
9953dc09a8SKonstantin Belousov 		return ("Intel 82865 host to AGP bridge");
10053dc09a8SKonstantin Belousov 	case 0x255d8086:
10153dc09a8SKonstantin Belousov 		return ("Intel E7205 host to AGP bridge");
10253dc09a8SKonstantin Belousov 	case 0x25508086:
10353dc09a8SKonstantin Belousov 		return ("Intel E7505 host to AGP bridge");
10453dc09a8SKonstantin Belousov 	case 0x25788086:
10553dc09a8SKonstantin Belousov 		return ("Intel 82875P host to AGP bridge");
10653dc09a8SKonstantin Belousov 	case 0x25608086:
10753dc09a8SKonstantin Belousov 		return ("Intel 82845G host to AGP bridge");
10853dc09a8SKonstantin Belousov 	case 0x35808086:
10953dc09a8SKonstantin Belousov 		return ("Intel 82855GM host to AGP bridge");
110dfa4d7fdSAntoine Brodin 	}
11159747216SDoug Rabson 
112ea9b97d2SJung-uk Kim 	return (NULL);
11359747216SDoug Rabson }
11459747216SDoug Rabson 
11559747216SDoug Rabson static int
11659747216SDoug Rabson agp_intel_probe(device_t dev)
11759747216SDoug Rabson {
11859747216SDoug Rabson 	const char *desc;
11959747216SDoug Rabson 
120a8de37b0SEitan Adler 	if (resource_disabled("agp", device_get_unit(dev)))
121a8de37b0SEitan Adler 		return (ENXIO);
12259747216SDoug Rabson 	desc = agp_intel_match(dev);
12359747216SDoug Rabson 	if (desc) {
12459747216SDoug Rabson 		device_set_desc(dev, desc);
125ea9b97d2SJung-uk Kim 		return (BUS_PROBE_DEFAULT);
12659747216SDoug Rabson 	}
12759747216SDoug Rabson 
128ea9b97d2SJung-uk Kim 	return (ENXIO);
12959747216SDoug Rabson }
13059747216SDoug Rabson 
131ea9b97d2SJung-uk Kim static void
132ea9b97d2SJung-uk Kim agp_intel_commit_gatt(device_t dev)
13359747216SDoug Rabson {
134ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
135ea9b97d2SJung-uk Kim 	u_int32_t type;
136ebca65b6SJohn Baldwin 	u_int32_t value;
13759747216SDoug Rabson 
138ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
139ea9b97d2SJung-uk Kim 	type = pci_get_devid(dev);
140ea9b97d2SJung-uk Kim 
14159747216SDoug Rabson 	/* Install the gatt. */
142ea9b97d2SJung-uk Kim 	pci_write_config(dev, AGP_INTEL_ATTBASE, sc->gatt->ag_physical, 4);
14359747216SDoug Rabson 
14480348907SJohn Baldwin 	/* Enable the GLTB and setup the control register. */
14580348907SJohn Baldwin 	switch (type) {
14680348907SJohn Baldwin 	case 0x71908086: /* 440LX/EX */
14780348907SJohn Baldwin 		pci_write_config(dev, AGP_INTEL_AGPCTRL, 0x2080, 4);
14880348907SJohn Baldwin 		break;
14980348907SJohn Baldwin 	case 0x71808086: /* 440BX */
15080348907SJohn Baldwin 		/*
15180348907SJohn Baldwin 		 * XXX: Should be 0xa080?  Bit 9 is undefined, and
15280348907SJohn Baldwin 		 * bit 13 being on and bit 15 being clear is illegal.
15380348907SJohn Baldwin 		 */
15480348907SJohn Baldwin 		pci_write_config(dev, AGP_INTEL_AGPCTRL, 0x2280, 4);
15580348907SJohn Baldwin 		break;
15680348907SJohn Baldwin 	default:
157e9ff34a5SJohn Baldwin 		value = pci_read_config(dev, AGP_INTEL_AGPCTRL, 4);
158e9ff34a5SJohn Baldwin 		pci_write_config(dev, AGP_INTEL_AGPCTRL, value | 0x80, 4);
15980348907SJohn Baldwin 	}
16080348907SJohn Baldwin 
161afadbf66SJung-uk Kim 	/* Enable aperture accesses. */
1626183dc49SJun Kuriyama 	switch (type) {
16353dc09a8SKonstantin Belousov 	case 0x25008086: /* i820 */
16453dc09a8SKonstantin Belousov 	case 0x25018086: /* i820 */
16553dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I820_RDCR,
16653dc09a8SKonstantin Belousov 				 (pci_read_config(dev, AGP_INTEL_I820_RDCR, 1)
16753dc09a8SKonstantin Belousov 				  | (1 << 1)), 1);
16853dc09a8SKonstantin Belousov 		break;
16953dc09a8SKonstantin Belousov 	case 0x1a308086: /* i845 */
17053dc09a8SKonstantin Belousov 	case 0x25608086: /* i845G */
17153dc09a8SKonstantin Belousov 	case 0x33408086: /* i855 */
17253dc09a8SKonstantin Belousov 	case 0x35808086: /* i855GM */
17353dc09a8SKonstantin Belousov 	case 0x25708086: /* i865 */
17453dc09a8SKonstantin Belousov 	case 0x25788086: /* i875P */
17553dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I845_AGPM,
17653dc09a8SKonstantin Belousov 				 (pci_read_config(dev, AGP_INTEL_I845_AGPM, 1)
17753dc09a8SKonstantin Belousov 				  | (1 << 1)), 1);
17853dc09a8SKonstantin Belousov 		break;
17953dc09a8SKonstantin Belousov 	case 0x1a218086: /* i840 */
18053dc09a8SKonstantin Belousov 	case 0x25308086: /* i850 */
18153dc09a8SKonstantin Belousov 	case 0x25318086: /* i860 */
18253dc09a8SKonstantin Belousov 	case 0x255d8086: /* E7205 */
18353dc09a8SKonstantin Belousov 	case 0x25508086: /* E7505 */
18453dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_MCHCFG,
18553dc09a8SKonstantin Belousov 				 (pci_read_config(dev, AGP_INTEL_MCHCFG, 2)
18653dc09a8SKonstantin Belousov 				  | (1 << 9)), 2);
18753dc09a8SKonstantin Belousov 		break;
1886183dc49SJun Kuriyama 	default: /* Intel Generic (maybe) */
18959747216SDoug Rabson 		pci_write_config(dev, AGP_INTEL_NBXCFG,
19059747216SDoug Rabson 				 (pci_read_config(dev, AGP_INTEL_NBXCFG, 4)
19159747216SDoug Rabson 				  & ~(1 << 10)) | (1 << 9), 4);
1926183dc49SJun Kuriyama 	}
1936183dc49SJun Kuriyama 
194afadbf66SJung-uk Kim 	/* Clear errors. */
1956183dc49SJun Kuriyama 	switch (type) {
19653dc09a8SKonstantin Belousov 	case 0x1a218086: /* i840 */
19753dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I8XX_ERRSTS, 0xc000, 2);
19853dc09a8SKonstantin Belousov 		break;
19953dc09a8SKonstantin Belousov 	case 0x25008086: /* i820 */
20053dc09a8SKonstantin Belousov 	case 0x25018086: /* i820 */
20153dc09a8SKonstantin Belousov 	case 0x1a308086: /* i845 */
20253dc09a8SKonstantin Belousov 	case 0x25608086: /* i845G */
20353dc09a8SKonstantin Belousov 	case 0x25308086: /* i850 */
20453dc09a8SKonstantin Belousov 	case 0x33408086: /* i855 */
20553dc09a8SKonstantin Belousov 	case 0x25318086: /* i860 */
20653dc09a8SKonstantin Belousov 	case 0x25708086: /* i865 */
20753dc09a8SKonstantin Belousov 	case 0x25788086: /* i875P */
20853dc09a8SKonstantin Belousov 	case 0x255d8086: /* E7205 */
20953dc09a8SKonstantin Belousov 	case 0x25508086: /* E7505 */
21053dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I8XX_ERRSTS, 0x00ff, 2);
21153dc09a8SKonstantin Belousov 		break;
2126183dc49SJun Kuriyama 	default: /* Intel Generic (maybe) */
21359747216SDoug Rabson 		pci_write_config(dev, AGP_INTEL_ERRSTS + 1, 7, 1);
2146183dc49SJun Kuriyama 	}
2159043d277STakanori Watanabe }
2169043d277STakanori Watanabe 
2179043d277STakanori Watanabe static int
2189043d277STakanori Watanabe agp_intel_attach(device_t dev)
2199043d277STakanori Watanabe {
220ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
2219043d277STakanori Watanabe 	struct agp_gatt *gatt;
2229043d277STakanori Watanabe 	u_int32_t value;
2239043d277STakanori Watanabe 	int error;
2249043d277STakanori Watanabe 
225ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
226ea9b97d2SJung-uk Kim 
2279043d277STakanori Watanabe 	error = agp_generic_attach(dev);
2289043d277STakanori Watanabe 	if (error)
229ea9b97d2SJung-uk Kim 		return (error);
2309043d277STakanori Watanabe 
2319043d277STakanori Watanabe 	/* Determine maximum supported aperture size. */
2329043d277STakanori Watanabe 	value = pci_read_config(dev, AGP_INTEL_APSIZE, 1);
2339043d277STakanori Watanabe 	pci_write_config(dev, AGP_INTEL_APSIZE, MAX_APSIZE, 1);
2349043d277STakanori Watanabe 	sc->aperture_mask = pci_read_config(dev, AGP_INTEL_APSIZE, 1) &
2359043d277STakanori Watanabe 	    MAX_APSIZE;
2369043d277STakanori Watanabe 	pci_write_config(dev, AGP_INTEL_APSIZE, value, 1);
237230a9294STakanori Watanabe 	sc->current_aperture = sc->initial_aperture = AGP_GET_APERTURE(dev);
2389043d277STakanori Watanabe 
2399043d277STakanori Watanabe 	for (;;) {
2409043d277STakanori Watanabe 		gatt = agp_alloc_gatt(dev);
2419043d277STakanori Watanabe 		if (gatt)
2429043d277STakanori Watanabe 			break;
2439043d277STakanori Watanabe 
2449043d277STakanori Watanabe 		/*
2459043d277STakanori Watanabe 		 * Probably contigmalloc failure. Try reducing the
2469043d277STakanori Watanabe 		 * aperture so that the gatt size reduces.
2479043d277STakanori Watanabe 		 */
2489043d277STakanori Watanabe 		if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) {
2499043d277STakanori Watanabe 			agp_generic_detach(dev);
250ea9b97d2SJung-uk Kim 			return (ENOMEM);
2519043d277STakanori Watanabe 		}
2529043d277STakanori Watanabe 	}
2539043d277STakanori Watanabe 	sc->gatt = gatt;
2549043d277STakanori Watanabe 
2559043d277STakanori Watanabe 	agp_intel_commit_gatt(dev);
25659747216SDoug Rabson 
257ea9b97d2SJung-uk Kim 	return (0);
25859747216SDoug Rabson }
25959747216SDoug Rabson 
26059747216SDoug Rabson static int
26159747216SDoug Rabson agp_intel_detach(device_t dev)
26259747216SDoug Rabson {
263ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
264afadbf66SJung-uk Kim 	u_int32_t reg;
26559747216SDoug Rabson 
266ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
267ea9b97d2SJung-uk Kim 
268f82a1d49SJohn Baldwin 	agp_free_cdev(dev);
26959747216SDoug Rabson 
270afadbf66SJung-uk Kim 	/* Disable aperture accesses. */
271ea9b97d2SJung-uk Kim 	switch (pci_get_devid(dev)) {
27253dc09a8SKonstantin Belousov 	case 0x25008086: /* i820 */
27353dc09a8SKonstantin Belousov 	case 0x25018086: /* i820 */
27453dc09a8SKonstantin Belousov 		reg = pci_read_config(dev, AGP_INTEL_I820_RDCR, 1) & ~(1 << 1);
27553dc09a8SKonstantin Belousov 		printf("%s: set RDCR to %02x\n", __func__, reg & 0xff);
27653dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I820_RDCR, reg, 1);
27753dc09a8SKonstantin Belousov 		break;
27853dc09a8SKonstantin Belousov 	case 0x1a308086: /* i845 */
27953dc09a8SKonstantin Belousov 	case 0x25608086: /* i845G */
28053dc09a8SKonstantin Belousov 	case 0x33408086: /* i855 */
28153dc09a8SKonstantin Belousov 	case 0x35808086: /* i855GM */
28253dc09a8SKonstantin Belousov 	case 0x25708086: /* i865 */
28353dc09a8SKonstantin Belousov 	case 0x25788086: /* i875P */
28453dc09a8SKonstantin Belousov 		reg = pci_read_config(dev, AGP_INTEL_I845_AGPM, 1) & ~(1 << 1);
28553dc09a8SKonstantin Belousov 		printf("%s: set AGPM to %02x\n", __func__, reg & 0xff);
28653dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I845_AGPM, reg, 1);
28753dc09a8SKonstantin Belousov 		break;
28853dc09a8SKonstantin Belousov 	case 0x1a218086: /* i840 */
28953dc09a8SKonstantin Belousov 	case 0x25308086: /* i850 */
29053dc09a8SKonstantin Belousov 	case 0x25318086: /* i860 */
29153dc09a8SKonstantin Belousov 	case 0x255d8086: /* E7205 */
29253dc09a8SKonstantin Belousov 	case 0x25508086: /* E7505 */
29353dc09a8SKonstantin Belousov 		reg = pci_read_config(dev, AGP_INTEL_MCHCFG, 2) & ~(1 << 9);
29453dc09a8SKonstantin Belousov 		printf("%s: set MCHCFG to %x04\n", __func__, reg & 0xffff);
29553dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_MCHCFG, reg, 2);
29653dc09a8SKonstantin Belousov 		break;
2976183dc49SJun Kuriyama 	default: /* Intel Generic (maybe) */
298afadbf66SJung-uk Kim 		reg = pci_read_config(dev, AGP_INTEL_NBXCFG, 4) & ~(1 << 9);
299afadbf66SJung-uk Kim 		printf("%s: set NBXCFG to %08x\n", __func__, reg);
300afadbf66SJung-uk Kim 		pci_write_config(dev, AGP_INTEL_NBXCFG, reg, 4);
3016183dc49SJun Kuriyama 	}
30259747216SDoug Rabson 	pci_write_config(dev, AGP_INTEL_ATTBASE, 0, 4);
30359747216SDoug Rabson 	AGP_SET_APERTURE(dev, sc->initial_aperture);
30459747216SDoug Rabson 	agp_free_gatt(sc->gatt);
305f82a1d49SJohn Baldwin 	agp_free_res(dev);
30659747216SDoug Rabson 
307ea9b97d2SJung-uk Kim 	return (0);
30859747216SDoug Rabson }
30959747216SDoug Rabson 
310ea9b97d2SJung-uk Kim static int
311ea9b97d2SJung-uk Kim agp_intel_resume(device_t dev)
3129043d277STakanori Watanabe {
313230a9294STakanori Watanabe 	struct agp_intel_softc *sc;
314230a9294STakanori Watanabe 	sc = device_get_softc(dev);
315230a9294STakanori Watanabe 
316230a9294STakanori Watanabe 	AGP_SET_APERTURE(dev, sc->current_aperture);
3179043d277STakanori Watanabe 	agp_intel_commit_gatt(dev);
318ea9b97d2SJung-uk Kim 	return (bus_generic_resume(dev));
3199043d277STakanori Watanabe }
3209043d277STakanori Watanabe 
32159747216SDoug Rabson static u_int32_t
32259747216SDoug Rabson agp_intel_get_aperture(device_t dev)
32359747216SDoug Rabson {
324ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
32559747216SDoug Rabson 	u_int32_t apsize;
32659747216SDoug Rabson 
327ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
328ea9b97d2SJung-uk Kim 
3294fb8dd97SJohn Baldwin 	apsize = pci_read_config(dev, AGP_INTEL_APSIZE, 1) & sc->aperture_mask;
33059747216SDoug Rabson 
33159747216SDoug Rabson 	/*
33259747216SDoug Rabson 	 * The size is determined by the number of low bits of
33359747216SDoug Rabson 	 * register APBASE which are forced to zero. The low 22 bits
33459747216SDoug Rabson 	 * are always forced to zero and each zero bit in the apsize
33559747216SDoug Rabson 	 * field just read forces the corresponding bit in the 27:22
33659747216SDoug Rabson 	 * to be zero. We calculate the aperture size accordingly.
33759747216SDoug Rabson 	 */
338ea9b97d2SJung-uk Kim 	return ((((apsize ^ sc->aperture_mask) << 22) | ((1 << 22) - 1)) + 1);
33959747216SDoug Rabson }
34059747216SDoug Rabson 
34159747216SDoug Rabson static int
34259747216SDoug Rabson agp_intel_set_aperture(device_t dev, u_int32_t aperture)
34359747216SDoug Rabson {
344ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
34559747216SDoug Rabson 	u_int32_t apsize;
34659747216SDoug Rabson 
347ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
348ea9b97d2SJung-uk Kim 
34959747216SDoug Rabson 	/*
35059747216SDoug Rabson 	 * Reverse the magic from get_aperture.
35159747216SDoug Rabson 	 */
3524fb8dd97SJohn Baldwin 	apsize = ((aperture - 1) >> 22) ^ sc->aperture_mask;
35359747216SDoug Rabson 
35459747216SDoug Rabson 	/*
35559747216SDoug Rabson 	 * Double check for sanity.
35659747216SDoug Rabson 	 */
3574fb8dd97SJohn Baldwin 	if ((((apsize ^ sc->aperture_mask) << 22) | ((1 << 22) - 1)) + 1 != aperture)
358ea9b97d2SJung-uk Kim 		return (EINVAL);
35959747216SDoug Rabson 
360230a9294STakanori Watanabe 	sc->current_aperture = apsize;
361230a9294STakanori Watanabe 
36259747216SDoug Rabson 	pci_write_config(dev, AGP_INTEL_APSIZE, apsize, 1);
36359747216SDoug Rabson 
364ea9b97d2SJung-uk Kim 	return (0);
36559747216SDoug Rabson }
36659747216SDoug Rabson 
36759747216SDoug Rabson static int
368cd6d5177SWarner Losh agp_intel_bind_page(device_t dev, vm_offset_t offset, vm_offset_t physical)
36959747216SDoug Rabson {
370ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
371ea9b97d2SJung-uk Kim 
372ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
37359747216SDoug Rabson 
37445d0290aSRobert Noland 	if (offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
375ea9b97d2SJung-uk Kim 		return (EINVAL);
37659747216SDoug Rabson 
37759747216SDoug Rabson 	sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical | 0x17;
378ea9b97d2SJung-uk Kim 	return (0);
37959747216SDoug Rabson }
38059747216SDoug Rabson 
38159747216SDoug Rabson static int
382cd6d5177SWarner Losh agp_intel_unbind_page(device_t dev, vm_offset_t offset)
38359747216SDoug Rabson {
384ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
385ea9b97d2SJung-uk Kim 
386ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
38759747216SDoug Rabson 
38845d0290aSRobert Noland 	if (offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
389ea9b97d2SJung-uk Kim 		return (EINVAL);
39059747216SDoug Rabson 
39159747216SDoug Rabson 	sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0;
392ea9b97d2SJung-uk Kim 	return (0);
39359747216SDoug Rabson }
39459747216SDoug Rabson 
39559747216SDoug Rabson static void
39659747216SDoug Rabson agp_intel_flush_tlb(device_t dev)
39759747216SDoug Rabson {
39880348907SJohn Baldwin 	u_int32_t val;
39980348907SJohn Baldwin 
40080348907SJohn Baldwin 	val = pci_read_config(dev, AGP_INTEL_AGPCTRL, 4);
401f704d346SEric Anholt 	pci_write_config(dev, AGP_INTEL_AGPCTRL, val & ~(1 << 7), 4);
40280348907SJohn Baldwin 	pci_write_config(dev, AGP_INTEL_AGPCTRL, val, 4);
40359747216SDoug Rabson }
40459747216SDoug Rabson 
40559747216SDoug Rabson static device_method_t agp_intel_methods[] = {
40659747216SDoug Rabson 	/* Device interface */
40759747216SDoug Rabson 	DEVMETHOD(device_probe,		agp_intel_probe),
40859747216SDoug Rabson 	DEVMETHOD(device_attach,	agp_intel_attach),
40959747216SDoug Rabson 	DEVMETHOD(device_detach,	agp_intel_detach),
41059747216SDoug Rabson 	DEVMETHOD(device_shutdown,	bus_generic_shutdown),
41159747216SDoug Rabson 	DEVMETHOD(device_suspend,	bus_generic_suspend),
4129043d277STakanori Watanabe 	DEVMETHOD(device_resume,	agp_intel_resume),
41359747216SDoug Rabson 
41459747216SDoug Rabson 	/* AGP interface */
41559747216SDoug Rabson 	DEVMETHOD(agp_get_aperture,	agp_intel_get_aperture),
41659747216SDoug Rabson 	DEVMETHOD(agp_set_aperture,	agp_intel_set_aperture),
41759747216SDoug Rabson 	DEVMETHOD(agp_bind_page,	agp_intel_bind_page),
41859747216SDoug Rabson 	DEVMETHOD(agp_unbind_page,	agp_intel_unbind_page),
41959747216SDoug Rabson 	DEVMETHOD(agp_flush_tlb,	agp_intel_flush_tlb),
42059747216SDoug Rabson 	DEVMETHOD(agp_enable,		agp_generic_enable),
42159747216SDoug Rabson 	DEVMETHOD(agp_alloc_memory,	agp_generic_alloc_memory),
42259747216SDoug Rabson 	DEVMETHOD(agp_free_memory,	agp_generic_free_memory),
42359747216SDoug Rabson 	DEVMETHOD(agp_bind_memory,	agp_generic_bind_memory),
42459747216SDoug Rabson 	DEVMETHOD(agp_unbind_memory,	agp_generic_unbind_memory),
42559747216SDoug Rabson 
42659747216SDoug Rabson 	{ 0, 0 }
42759747216SDoug Rabson };
42859747216SDoug Rabson 
42959747216SDoug Rabson static driver_t agp_intel_driver = {
43059747216SDoug Rabson 	"agp",
43159747216SDoug Rabson 	agp_intel_methods,
43259747216SDoug Rabson 	sizeof(struct agp_intel_softc),
43359747216SDoug Rabson };
43459747216SDoug Rabson 
43559747216SDoug Rabson static devclass_t agp_devclass;
43659747216SDoug Rabson 
437c626f1feSJohn Baldwin DRIVER_MODULE(agp_intel, hostb, agp_intel_driver, agp_devclass, 0, 0);
438f246e4a1SMatthew N. Dodd MODULE_DEPEND(agp_intel, agp, 1, 1, 1);
439f246e4a1SMatthew N. Dodd MODULE_DEPEND(agp_intel, pci, 1, 1, 1);
440