xref: /freebsd/sys/dev/agp/agp_intel.c (revision fdafd315ad0d0f28a11b9fb4476a9ab059c62b92)
159747216SDoug Rabson /*-
2*4d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro 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 
2959747216SDoug Rabson #include <sys/param.h>
3059747216SDoug Rabson #include <sys/systm.h>
3159747216SDoug Rabson #include <sys/malloc.h>
3259747216SDoug Rabson #include <sys/kernel.h>
33f11d01c3SPoul-Henning Kamp #include <sys/module.h>
3459747216SDoug Rabson #include <sys/bus.h>
3559747216SDoug Rabson #include <sys/lock.h>
3623955314SAlfred Perlstein #include <sys/mutex.h>
3752b3919dSJohn Baldwin #include <sys/proc.h>
3859747216SDoug Rabson 
39dbac8ff4SJohn Baldwin #include <dev/agp/agppriv.h>
40dbac8ff4SJohn Baldwin #include <dev/agp/agpreg.h>
4119b7ffd1SWarner Losh #include <dev/pci/pcivar.h>
4219b7ffd1SWarner Losh #include <dev/pci/pcireg.h>
4359747216SDoug Rabson 
4459747216SDoug Rabson #include <vm/vm.h>
4559747216SDoug Rabson #include <vm/vm_object.h>
4659747216SDoug Rabson #include <vm/pmap.h>
4759747216SDoug Rabson 
484fb8dd97SJohn Baldwin #define	MAX_APSIZE	0x3f		/* 256 MB */
494fb8dd97SJohn Baldwin 
5059747216SDoug Rabson struct agp_intel_softc {
5159747216SDoug Rabson 	struct agp_softc agp;
5259747216SDoug Rabson 	u_int32_t	initial_aperture; /* aperture size at startup */
5359747216SDoug Rabson 	struct agp_gatt *gatt;
544fb8dd97SJohn Baldwin 	u_int		aperture_mask;
55230a9294STakanori Watanabe 	u_int32_t	current_aperture; /* current aperture size */
5659747216SDoug Rabson };
5759747216SDoug Rabson 
5859747216SDoug Rabson static const char*
agp_intel_match(device_t dev)5959747216SDoug Rabson agp_intel_match(device_t dev)
6059747216SDoug Rabson {
6159747216SDoug Rabson 	if (pci_get_class(dev) != PCIC_BRIDGE
6259747216SDoug Rabson 	    || pci_get_subclass(dev) != PCIS_BRIDGE_HOST)
63ea9b97d2SJung-uk Kim 		return (NULL);
6459747216SDoug Rabson 
6559747216SDoug Rabson 	if (agp_find_caps(dev) == 0)
66ea9b97d2SJung-uk Kim 		return (NULL);
6759747216SDoug Rabson 
6859747216SDoug Rabson 	switch (pci_get_devid(dev)) {
6959747216SDoug Rabson 	/* Intel -- vendor 0x8086 */
7059747216SDoug Rabson 	case 0x71808086:
7159747216SDoug Rabson 		return ("Intel 82443LX (440 LX) host to PCI bridge");
7259747216SDoug Rabson 	case 0x71908086:
7359747216SDoug Rabson 		return ("Intel 82443BX (440 BX) host to PCI bridge");
7459747216SDoug Rabson  	case 0x71a08086:
7559747216SDoug Rabson  		return ("Intel 82443GX host to PCI bridge");
7659747216SDoug Rabson  	case 0x71a18086:
7759747216SDoug Rabson  		return ("Intel 82443GX host to AGP bridge");
7853dc09a8SKonstantin Belousov 	case 0x11308086:
7953dc09a8SKonstantin Belousov 		return ("Intel 82815 (i815 GMCH) host to PCI bridge");
8053dc09a8SKonstantin Belousov 	case 0x25008086:
8153dc09a8SKonstantin Belousov 	case 0x25018086:
8253dc09a8SKonstantin Belousov 		return ("Intel 82820 host to AGP bridge");
8353dc09a8SKonstantin Belousov 	case 0x35758086:
8453dc09a8SKonstantin Belousov 		return ("Intel 82830 host to AGP bridge");
8553dc09a8SKonstantin Belousov 	case 0x1a218086:
8653dc09a8SKonstantin Belousov 		return ("Intel 82840 host to AGP bridge");
8753dc09a8SKonstantin Belousov 	case 0x1a308086:
8853dc09a8SKonstantin Belousov 		return ("Intel 82845 host to AGP bridge");
8953dc09a8SKonstantin Belousov 	case 0x25308086:
9053dc09a8SKonstantin Belousov 		return ("Intel 82850 host to AGP bridge");
9153dc09a8SKonstantin Belousov 	case 0x33408086:
9253dc09a8SKonstantin Belousov 		return ("Intel 82855 host to AGP bridge");
9353dc09a8SKonstantin Belousov 	case 0x25318086:
9453dc09a8SKonstantin Belousov 		return ("Intel 82860 host to AGP bridge");
9553dc09a8SKonstantin Belousov 	case 0x25708086:
9653dc09a8SKonstantin Belousov 		return ("Intel 82865 host to AGP bridge");
9753dc09a8SKonstantin Belousov 	case 0x255d8086:
9853dc09a8SKonstantin Belousov 		return ("Intel E7205 host to AGP bridge");
9953dc09a8SKonstantin Belousov 	case 0x25508086:
10053dc09a8SKonstantin Belousov 		return ("Intel E7505 host to AGP bridge");
10153dc09a8SKonstantin Belousov 	case 0x25788086:
10253dc09a8SKonstantin Belousov 		return ("Intel 82875P host to AGP bridge");
10353dc09a8SKonstantin Belousov 	case 0x25608086:
10453dc09a8SKonstantin Belousov 		return ("Intel 82845G host to AGP bridge");
10553dc09a8SKonstantin Belousov 	case 0x35808086:
10653dc09a8SKonstantin Belousov 		return ("Intel 82855GM host to AGP bridge");
107dfa4d7fdSAntoine Brodin 	}
10859747216SDoug Rabson 
109ea9b97d2SJung-uk Kim 	return (NULL);
11059747216SDoug Rabson }
11159747216SDoug Rabson 
11259747216SDoug Rabson static int
agp_intel_probe(device_t dev)11359747216SDoug Rabson agp_intel_probe(device_t dev)
11459747216SDoug Rabson {
11559747216SDoug Rabson 	const char *desc;
11659747216SDoug Rabson 
117a8de37b0SEitan Adler 	if (resource_disabled("agp", device_get_unit(dev)))
118a8de37b0SEitan Adler 		return (ENXIO);
11959747216SDoug Rabson 	desc = agp_intel_match(dev);
12059747216SDoug Rabson 	if (desc) {
12159747216SDoug Rabson 		device_set_desc(dev, desc);
122ea9b97d2SJung-uk Kim 		return (BUS_PROBE_DEFAULT);
12359747216SDoug Rabson 	}
12459747216SDoug Rabson 
125ea9b97d2SJung-uk Kim 	return (ENXIO);
12659747216SDoug Rabson }
12759747216SDoug Rabson 
128ea9b97d2SJung-uk Kim static void
agp_intel_commit_gatt(device_t dev)129ea9b97d2SJung-uk Kim agp_intel_commit_gatt(device_t dev)
13059747216SDoug Rabson {
131ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
132ea9b97d2SJung-uk Kim 	u_int32_t type;
133ebca65b6SJohn Baldwin 	u_int32_t value;
13459747216SDoug Rabson 
135ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
136ea9b97d2SJung-uk Kim 	type = pci_get_devid(dev);
137ea9b97d2SJung-uk Kim 
13859747216SDoug Rabson 	/* Install the gatt. */
139ea9b97d2SJung-uk Kim 	pci_write_config(dev, AGP_INTEL_ATTBASE, sc->gatt->ag_physical, 4);
14059747216SDoug Rabson 
14180348907SJohn Baldwin 	/* Enable the GLTB and setup the control register. */
14280348907SJohn Baldwin 	switch (type) {
14380348907SJohn Baldwin 	case 0x71908086: /* 440LX/EX */
14480348907SJohn Baldwin 		pci_write_config(dev, AGP_INTEL_AGPCTRL, 0x2080, 4);
14580348907SJohn Baldwin 		break;
14680348907SJohn Baldwin 	case 0x71808086: /* 440BX */
14780348907SJohn Baldwin 		/*
14880348907SJohn Baldwin 		 * XXX: Should be 0xa080?  Bit 9 is undefined, and
14980348907SJohn Baldwin 		 * bit 13 being on and bit 15 being clear is illegal.
15080348907SJohn Baldwin 		 */
15180348907SJohn Baldwin 		pci_write_config(dev, AGP_INTEL_AGPCTRL, 0x2280, 4);
15280348907SJohn Baldwin 		break;
15380348907SJohn Baldwin 	default:
154e9ff34a5SJohn Baldwin 		value = pci_read_config(dev, AGP_INTEL_AGPCTRL, 4);
155e9ff34a5SJohn Baldwin 		pci_write_config(dev, AGP_INTEL_AGPCTRL, value | 0x80, 4);
15680348907SJohn Baldwin 	}
15780348907SJohn Baldwin 
158afadbf66SJung-uk Kim 	/* Enable aperture accesses. */
1596183dc49SJun Kuriyama 	switch (type) {
16053dc09a8SKonstantin Belousov 	case 0x25008086: /* i820 */
16153dc09a8SKonstantin Belousov 	case 0x25018086: /* i820 */
16253dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I820_RDCR,
16353dc09a8SKonstantin Belousov 				 (pci_read_config(dev, AGP_INTEL_I820_RDCR, 1)
16453dc09a8SKonstantin Belousov 				  | (1 << 1)), 1);
16553dc09a8SKonstantin Belousov 		break;
16653dc09a8SKonstantin Belousov 	case 0x1a308086: /* i845 */
16753dc09a8SKonstantin Belousov 	case 0x25608086: /* i845G */
16853dc09a8SKonstantin Belousov 	case 0x33408086: /* i855 */
16953dc09a8SKonstantin Belousov 	case 0x35808086: /* i855GM */
17053dc09a8SKonstantin Belousov 	case 0x25708086: /* i865 */
17153dc09a8SKonstantin Belousov 	case 0x25788086: /* i875P */
17253dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I845_AGPM,
17353dc09a8SKonstantin Belousov 				 (pci_read_config(dev, AGP_INTEL_I845_AGPM, 1)
17453dc09a8SKonstantin Belousov 				  | (1 << 1)), 1);
17553dc09a8SKonstantin Belousov 		break;
17653dc09a8SKonstantin Belousov 	case 0x1a218086: /* i840 */
17753dc09a8SKonstantin Belousov 	case 0x25308086: /* i850 */
17853dc09a8SKonstantin Belousov 	case 0x25318086: /* i860 */
17953dc09a8SKonstantin Belousov 	case 0x255d8086: /* E7205 */
18053dc09a8SKonstantin Belousov 	case 0x25508086: /* E7505 */
18153dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_MCHCFG,
18253dc09a8SKonstantin Belousov 				 (pci_read_config(dev, AGP_INTEL_MCHCFG, 2)
18353dc09a8SKonstantin Belousov 				  | (1 << 9)), 2);
18453dc09a8SKonstantin Belousov 		break;
1856183dc49SJun Kuriyama 	default: /* Intel Generic (maybe) */
18659747216SDoug Rabson 		pci_write_config(dev, AGP_INTEL_NBXCFG,
18759747216SDoug Rabson 				 (pci_read_config(dev, AGP_INTEL_NBXCFG, 4)
18859747216SDoug Rabson 				  & ~(1 << 10)) | (1 << 9), 4);
1896183dc49SJun Kuriyama 	}
1906183dc49SJun Kuriyama 
191afadbf66SJung-uk Kim 	/* Clear errors. */
1926183dc49SJun Kuriyama 	switch (type) {
19353dc09a8SKonstantin Belousov 	case 0x1a218086: /* i840 */
19453dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I8XX_ERRSTS, 0xc000, 2);
19553dc09a8SKonstantin Belousov 		break;
19653dc09a8SKonstantin Belousov 	case 0x25008086: /* i820 */
19753dc09a8SKonstantin Belousov 	case 0x25018086: /* i820 */
19853dc09a8SKonstantin Belousov 	case 0x1a308086: /* i845 */
19953dc09a8SKonstantin Belousov 	case 0x25608086: /* i845G */
20053dc09a8SKonstantin Belousov 	case 0x25308086: /* i850 */
20153dc09a8SKonstantin Belousov 	case 0x33408086: /* i855 */
20253dc09a8SKonstantin Belousov 	case 0x25318086: /* i860 */
20353dc09a8SKonstantin Belousov 	case 0x25708086: /* i865 */
20453dc09a8SKonstantin Belousov 	case 0x25788086: /* i875P */
20553dc09a8SKonstantin Belousov 	case 0x255d8086: /* E7205 */
20653dc09a8SKonstantin Belousov 	case 0x25508086: /* E7505 */
20753dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I8XX_ERRSTS, 0x00ff, 2);
20853dc09a8SKonstantin Belousov 		break;
2096183dc49SJun Kuriyama 	default: /* Intel Generic (maybe) */
21059747216SDoug Rabson 		pci_write_config(dev, AGP_INTEL_ERRSTS + 1, 7, 1);
2116183dc49SJun Kuriyama 	}
2129043d277STakanori Watanabe }
2139043d277STakanori Watanabe 
2149043d277STakanori Watanabe static int
agp_intel_attach(device_t dev)2159043d277STakanori Watanabe agp_intel_attach(device_t dev)
2169043d277STakanori Watanabe {
217ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
2189043d277STakanori Watanabe 	struct agp_gatt *gatt;
2199043d277STakanori Watanabe 	u_int32_t value;
2209043d277STakanori Watanabe 	int error;
2219043d277STakanori Watanabe 
222ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
223ea9b97d2SJung-uk Kim 
2249043d277STakanori Watanabe 	error = agp_generic_attach(dev);
2259043d277STakanori Watanabe 	if (error)
226ea9b97d2SJung-uk Kim 		return (error);
2279043d277STakanori Watanabe 
2289043d277STakanori Watanabe 	/* Determine maximum supported aperture size. */
2299043d277STakanori Watanabe 	value = pci_read_config(dev, AGP_INTEL_APSIZE, 1);
2309043d277STakanori Watanabe 	pci_write_config(dev, AGP_INTEL_APSIZE, MAX_APSIZE, 1);
2319043d277STakanori Watanabe 	sc->aperture_mask = pci_read_config(dev, AGP_INTEL_APSIZE, 1) &
2329043d277STakanori Watanabe 	    MAX_APSIZE;
2339043d277STakanori Watanabe 	pci_write_config(dev, AGP_INTEL_APSIZE, value, 1);
234230a9294STakanori Watanabe 	sc->current_aperture = sc->initial_aperture = AGP_GET_APERTURE(dev);
2359043d277STakanori Watanabe 
2369043d277STakanori Watanabe 	for (;;) {
2379043d277STakanori Watanabe 		gatt = agp_alloc_gatt(dev);
2389043d277STakanori Watanabe 		if (gatt)
2399043d277STakanori Watanabe 			break;
2409043d277STakanori Watanabe 
2419043d277STakanori Watanabe 		/*
2429043d277STakanori Watanabe 		 * Probably contigmalloc failure. Try reducing the
2439043d277STakanori Watanabe 		 * aperture so that the gatt size reduces.
2449043d277STakanori Watanabe 		 */
2459043d277STakanori Watanabe 		if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) {
2469043d277STakanori Watanabe 			agp_generic_detach(dev);
247ea9b97d2SJung-uk Kim 			return (ENOMEM);
2489043d277STakanori Watanabe 		}
2499043d277STakanori Watanabe 	}
2509043d277STakanori Watanabe 	sc->gatt = gatt;
2519043d277STakanori Watanabe 
2529043d277STakanori Watanabe 	agp_intel_commit_gatt(dev);
25359747216SDoug Rabson 
254ea9b97d2SJung-uk Kim 	return (0);
25559747216SDoug Rabson }
25659747216SDoug Rabson 
25759747216SDoug Rabson static int
agp_intel_detach(device_t dev)25859747216SDoug Rabson agp_intel_detach(device_t dev)
25959747216SDoug Rabson {
260ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
261afadbf66SJung-uk Kim 	u_int32_t reg;
26259747216SDoug Rabson 
263ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
264ea9b97d2SJung-uk Kim 
265f82a1d49SJohn Baldwin 	agp_free_cdev(dev);
26659747216SDoug Rabson 
267afadbf66SJung-uk Kim 	/* Disable aperture accesses. */
268ea9b97d2SJung-uk Kim 	switch (pci_get_devid(dev)) {
26953dc09a8SKonstantin Belousov 	case 0x25008086: /* i820 */
27053dc09a8SKonstantin Belousov 	case 0x25018086: /* i820 */
27153dc09a8SKonstantin Belousov 		reg = pci_read_config(dev, AGP_INTEL_I820_RDCR, 1) & ~(1 << 1);
27253dc09a8SKonstantin Belousov 		printf("%s: set RDCR to %02x\n", __func__, reg & 0xff);
27353dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I820_RDCR, reg, 1);
27453dc09a8SKonstantin Belousov 		break;
27553dc09a8SKonstantin Belousov 	case 0x1a308086: /* i845 */
27653dc09a8SKonstantin Belousov 	case 0x25608086: /* i845G */
27753dc09a8SKonstantin Belousov 	case 0x33408086: /* i855 */
27853dc09a8SKonstantin Belousov 	case 0x35808086: /* i855GM */
27953dc09a8SKonstantin Belousov 	case 0x25708086: /* i865 */
28053dc09a8SKonstantin Belousov 	case 0x25788086: /* i875P */
28153dc09a8SKonstantin Belousov 		reg = pci_read_config(dev, AGP_INTEL_I845_AGPM, 1) & ~(1 << 1);
28253dc09a8SKonstantin Belousov 		printf("%s: set AGPM to %02x\n", __func__, reg & 0xff);
28353dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_I845_AGPM, reg, 1);
28453dc09a8SKonstantin Belousov 		break;
28553dc09a8SKonstantin Belousov 	case 0x1a218086: /* i840 */
28653dc09a8SKonstantin Belousov 	case 0x25308086: /* i850 */
28753dc09a8SKonstantin Belousov 	case 0x25318086: /* i860 */
28853dc09a8SKonstantin Belousov 	case 0x255d8086: /* E7205 */
28953dc09a8SKonstantin Belousov 	case 0x25508086: /* E7505 */
29053dc09a8SKonstantin Belousov 		reg = pci_read_config(dev, AGP_INTEL_MCHCFG, 2) & ~(1 << 9);
29153dc09a8SKonstantin Belousov 		printf("%s: set MCHCFG to %x04\n", __func__, reg & 0xffff);
29253dc09a8SKonstantin Belousov 		pci_write_config(dev, AGP_INTEL_MCHCFG, reg, 2);
29353dc09a8SKonstantin Belousov 		break;
2946183dc49SJun Kuriyama 	default: /* Intel Generic (maybe) */
295afadbf66SJung-uk Kim 		reg = pci_read_config(dev, AGP_INTEL_NBXCFG, 4) & ~(1 << 9);
296afadbf66SJung-uk Kim 		printf("%s: set NBXCFG to %08x\n", __func__, reg);
297afadbf66SJung-uk Kim 		pci_write_config(dev, AGP_INTEL_NBXCFG, reg, 4);
2986183dc49SJun Kuriyama 	}
29959747216SDoug Rabson 	pci_write_config(dev, AGP_INTEL_ATTBASE, 0, 4);
30059747216SDoug Rabson 	AGP_SET_APERTURE(dev, sc->initial_aperture);
30159747216SDoug Rabson 	agp_free_gatt(sc->gatt);
302f82a1d49SJohn Baldwin 	agp_free_res(dev);
30359747216SDoug Rabson 
304ea9b97d2SJung-uk Kim 	return (0);
30559747216SDoug Rabson }
30659747216SDoug Rabson 
307ea9b97d2SJung-uk Kim static int
agp_intel_resume(device_t dev)308ea9b97d2SJung-uk Kim agp_intel_resume(device_t dev)
3099043d277STakanori Watanabe {
310230a9294STakanori Watanabe 	struct agp_intel_softc *sc;
311230a9294STakanori Watanabe 	sc = device_get_softc(dev);
312230a9294STakanori Watanabe 
313230a9294STakanori Watanabe 	AGP_SET_APERTURE(dev, sc->current_aperture);
3149043d277STakanori Watanabe 	agp_intel_commit_gatt(dev);
315ea9b97d2SJung-uk Kim 	return (bus_generic_resume(dev));
3169043d277STakanori Watanabe }
3179043d277STakanori Watanabe 
31859747216SDoug Rabson static u_int32_t
agp_intel_get_aperture(device_t dev)31959747216SDoug Rabson agp_intel_get_aperture(device_t dev)
32059747216SDoug Rabson {
321ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
32259747216SDoug Rabson 	u_int32_t apsize;
32359747216SDoug Rabson 
324ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
325ea9b97d2SJung-uk Kim 
3264fb8dd97SJohn Baldwin 	apsize = pci_read_config(dev, AGP_INTEL_APSIZE, 1) & sc->aperture_mask;
32759747216SDoug Rabson 
32859747216SDoug Rabson 	/*
32959747216SDoug Rabson 	 * The size is determined by the number of low bits of
33059747216SDoug Rabson 	 * register APBASE which are forced to zero. The low 22 bits
33159747216SDoug Rabson 	 * are always forced to zero and each zero bit in the apsize
33259747216SDoug Rabson 	 * field just read forces the corresponding bit in the 27:22
33359747216SDoug Rabson 	 * to be zero. We calculate the aperture size accordingly.
33459747216SDoug Rabson 	 */
335ea9b97d2SJung-uk Kim 	return ((((apsize ^ sc->aperture_mask) << 22) | ((1 << 22) - 1)) + 1);
33659747216SDoug Rabson }
33759747216SDoug Rabson 
33859747216SDoug Rabson static int
agp_intel_set_aperture(device_t dev,u_int32_t aperture)33959747216SDoug Rabson agp_intel_set_aperture(device_t dev, u_int32_t aperture)
34059747216SDoug Rabson {
341ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
34259747216SDoug Rabson 	u_int32_t apsize;
34359747216SDoug Rabson 
344ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
345ea9b97d2SJung-uk Kim 
34659747216SDoug Rabson 	/*
34759747216SDoug Rabson 	 * Reverse the magic from get_aperture.
34859747216SDoug Rabson 	 */
3494fb8dd97SJohn Baldwin 	apsize = ((aperture - 1) >> 22) ^ sc->aperture_mask;
35059747216SDoug Rabson 
35159747216SDoug Rabson 	/*
35259747216SDoug Rabson 	 * Double check for sanity.
35359747216SDoug Rabson 	 */
3544fb8dd97SJohn Baldwin 	if ((((apsize ^ sc->aperture_mask) << 22) | ((1 << 22) - 1)) + 1 != aperture)
355ea9b97d2SJung-uk Kim 		return (EINVAL);
35659747216SDoug Rabson 
357230a9294STakanori Watanabe 	sc->current_aperture = apsize;
358230a9294STakanori Watanabe 
35959747216SDoug Rabson 	pci_write_config(dev, AGP_INTEL_APSIZE, apsize, 1);
36059747216SDoug Rabson 
361ea9b97d2SJung-uk Kim 	return (0);
36259747216SDoug Rabson }
36359747216SDoug Rabson 
36459747216SDoug Rabson static int
agp_intel_bind_page(device_t dev,vm_offset_t offset,vm_offset_t physical)365cd6d5177SWarner Losh agp_intel_bind_page(device_t dev, vm_offset_t offset, vm_offset_t physical)
36659747216SDoug Rabson {
367ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
368ea9b97d2SJung-uk Kim 
369ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
37059747216SDoug Rabson 
37145d0290aSRobert Noland 	if (offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
372ea9b97d2SJung-uk Kim 		return (EINVAL);
37359747216SDoug Rabson 
37459747216SDoug Rabson 	sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical | 0x17;
375ea9b97d2SJung-uk Kim 	return (0);
37659747216SDoug Rabson }
37759747216SDoug Rabson 
37859747216SDoug Rabson static int
agp_intel_unbind_page(device_t dev,vm_offset_t offset)379cd6d5177SWarner Losh agp_intel_unbind_page(device_t dev, vm_offset_t offset)
38059747216SDoug Rabson {
381ea9b97d2SJung-uk Kim 	struct agp_intel_softc *sc;
382ea9b97d2SJung-uk Kim 
383ea9b97d2SJung-uk Kim 	sc = device_get_softc(dev);
38459747216SDoug Rabson 
38545d0290aSRobert Noland 	if (offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
386ea9b97d2SJung-uk Kim 		return (EINVAL);
38759747216SDoug Rabson 
38859747216SDoug Rabson 	sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0;
389ea9b97d2SJung-uk Kim 	return (0);
39059747216SDoug Rabson }
39159747216SDoug Rabson 
39259747216SDoug Rabson static void
agp_intel_flush_tlb(device_t dev)39359747216SDoug Rabson agp_intel_flush_tlb(device_t dev)
39459747216SDoug Rabson {
39580348907SJohn Baldwin 	u_int32_t val;
39680348907SJohn Baldwin 
39780348907SJohn Baldwin 	val = pci_read_config(dev, AGP_INTEL_AGPCTRL, 4);
398f704d346SEric Anholt 	pci_write_config(dev, AGP_INTEL_AGPCTRL, val & ~(1 << 7), 4);
39980348907SJohn Baldwin 	pci_write_config(dev, AGP_INTEL_AGPCTRL, val, 4);
40059747216SDoug Rabson }
40159747216SDoug Rabson 
40259747216SDoug Rabson static device_method_t agp_intel_methods[] = {
40359747216SDoug Rabson 	/* Device interface */
40459747216SDoug Rabson 	DEVMETHOD(device_probe,		agp_intel_probe),
40559747216SDoug Rabson 	DEVMETHOD(device_attach,	agp_intel_attach),
40659747216SDoug Rabson 	DEVMETHOD(device_detach,	agp_intel_detach),
40759747216SDoug Rabson 	DEVMETHOD(device_shutdown,	bus_generic_shutdown),
40859747216SDoug Rabson 	DEVMETHOD(device_suspend,	bus_generic_suspend),
4099043d277STakanori Watanabe 	DEVMETHOD(device_resume,	agp_intel_resume),
41059747216SDoug Rabson 
41159747216SDoug Rabson 	/* AGP interface */
41259747216SDoug Rabson 	DEVMETHOD(agp_get_aperture,	agp_intel_get_aperture),
41359747216SDoug Rabson 	DEVMETHOD(agp_set_aperture,	agp_intel_set_aperture),
41459747216SDoug Rabson 	DEVMETHOD(agp_bind_page,	agp_intel_bind_page),
41559747216SDoug Rabson 	DEVMETHOD(agp_unbind_page,	agp_intel_unbind_page),
41659747216SDoug Rabson 	DEVMETHOD(agp_flush_tlb,	agp_intel_flush_tlb),
41759747216SDoug Rabson 	DEVMETHOD(agp_enable,		agp_generic_enable),
41859747216SDoug Rabson 	DEVMETHOD(agp_alloc_memory,	agp_generic_alloc_memory),
41959747216SDoug Rabson 	DEVMETHOD(agp_free_memory,	agp_generic_free_memory),
42059747216SDoug Rabson 	DEVMETHOD(agp_bind_memory,	agp_generic_bind_memory),
42159747216SDoug Rabson 	DEVMETHOD(agp_unbind_memory,	agp_generic_unbind_memory),
42259747216SDoug Rabson 	{ 0, 0 }
42359747216SDoug Rabson };
42459747216SDoug Rabson 
42559747216SDoug Rabson static driver_t agp_intel_driver = {
42659747216SDoug Rabson 	"agp",
42759747216SDoug Rabson 	agp_intel_methods,
42859747216SDoug Rabson 	sizeof(struct agp_intel_softc),
42959747216SDoug Rabson };
43059747216SDoug Rabson 
43174f84981SJohn Baldwin DRIVER_MODULE(agp_intel, hostb, agp_intel_driver, 0, 0);
432f246e4a1SMatthew N. Dodd MODULE_DEPEND(agp_intel, agp, 1, 1, 1);
433f246e4a1SMatthew N. Dodd MODULE_DEPEND(agp_intel, pci, 1, 1, 1);
434