xref: /freebsd/sys/dev/agp/agp.c (revision dbac8ff40032ae79e4a5dda8237f5dc1765420eb)
159747216SDoug Rabson /*-
259747216SDoug Rabson  * Copyright (c) 2000 Doug Rabson
359747216SDoug Rabson  * All rights reserved.
459747216SDoug Rabson  *
559747216SDoug Rabson  * Redistribution and use in source and binary forms, with or without
659747216SDoug Rabson  * modification, are permitted provided that the following conditions
759747216SDoug Rabson  * are met:
859747216SDoug Rabson  * 1. Redistributions of source code must retain the above copyright
959747216SDoug Rabson  *    notice, this list of conditions and the following disclaimer.
1059747216SDoug Rabson  * 2. Redistributions in binary form must reproduce the above copyright
1159747216SDoug Rabson  *    notice, this list of conditions and the following disclaimer in the
1259747216SDoug Rabson  *    documentation and/or other materials provided with the distribution.
1359747216SDoug Rabson  *
1459747216SDoug Rabson  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1559747216SDoug Rabson  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1659747216SDoug Rabson  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1759747216SDoug Rabson  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1859747216SDoug Rabson  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
1959747216SDoug Rabson  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2059747216SDoug Rabson  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2159747216SDoug Rabson  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2259747216SDoug Rabson  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2359747216SDoug Rabson  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2459747216SDoug Rabson  * SUCH DAMAGE.
2559747216SDoug Rabson  */
2659747216SDoug Rabson 
27f4636c59SDavid E. O'Brien #include <sys/cdefs.h>
28f4636c59SDavid E. O'Brien __FBSDID("$FreeBSD$");
29f4636c59SDavid E. O'Brien 
3059747216SDoug Rabson #include "opt_bus.h"
3159747216SDoug Rabson 
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/conf.h>
3959747216SDoug Rabson #include <sys/ioccom.h>
4059747216SDoug Rabson #include <sys/agpio.h>
4159747216SDoug Rabson #include <sys/lock.h>
4223955314SAlfred Perlstein #include <sys/mutex.h>
431639f08bSJohn Baldwin #include <sys/proc.h>
4459747216SDoug Rabson 
45dbac8ff4SJohn Baldwin #include <dev/agp/agppriv.h>
46dbac8ff4SJohn Baldwin #include <dev/agp/agpvar.h>
47dbac8ff4SJohn Baldwin #include <dev/agp/agpreg.h>
4819b7ffd1SWarner Losh #include <dev/pci/pcivar.h>
4919b7ffd1SWarner Losh #include <dev/pci/pcireg.h>
5059747216SDoug Rabson 
5159747216SDoug Rabson #include <vm/vm.h>
5259747216SDoug Rabson #include <vm/vm_object.h>
5359747216SDoug Rabson #include <vm/vm_page.h>
5459747216SDoug Rabson #include <vm/vm_pageout.h>
5559747216SDoug Rabson #include <vm/pmap.h>
5659747216SDoug Rabson 
5759747216SDoug Rabson #include <machine/md_var.h>
5859747216SDoug Rabson #include <machine/bus.h>
5959747216SDoug Rabson #include <machine/resource.h>
6059747216SDoug Rabson #include <sys/rman.h>
6159747216SDoug Rabson 
6259747216SDoug Rabson MODULE_VERSION(agp, 1);
6359747216SDoug Rabson 
64315a1645SAssar Westerlund MALLOC_DEFINE(M_AGP, "agp", "AGP data structures");
6559747216SDoug Rabson 
6659747216SDoug Rabson 				/* agp_drv.c */
6759747216SDoug Rabson static d_open_t agp_open;
6859747216SDoug Rabson static d_close_t agp_close;
6959747216SDoug Rabson static d_ioctl_t agp_ioctl;
7059747216SDoug Rabson static d_mmap_t agp_mmap;
7159747216SDoug Rabson 
7259747216SDoug Rabson static struct cdevsw agp_cdevsw = {
73dc08ffecSPoul-Henning Kamp 	.d_version =	D_VERSION,
74dc08ffecSPoul-Henning Kamp 	.d_flags =	D_NEEDGIANT,
757ac40f5fSPoul-Henning Kamp 	.d_open =	agp_open,
767ac40f5fSPoul-Henning Kamp 	.d_close =	agp_close,
777ac40f5fSPoul-Henning Kamp 	.d_ioctl =	agp_ioctl,
787ac40f5fSPoul-Henning Kamp 	.d_mmap =	agp_mmap,
797ac40f5fSPoul-Henning Kamp 	.d_name =	"agp",
8059747216SDoug Rabson };
8159747216SDoug Rabson 
8259747216SDoug Rabson static devclass_t agp_devclass;
8359747216SDoug Rabson #define KDEV2DEV(kdev)	devclass_get_device(agp_devclass, minor(kdev))
8459747216SDoug Rabson 
8559747216SDoug Rabson /* Helper functions for implementing chipset mini drivers. */
8659747216SDoug Rabson 
87111618cbSDoug Rabson void
88111618cbSDoug Rabson agp_flush_cache()
89111618cbSDoug Rabson {
903c749e3fSDavid E. O'Brien #if defined(__i386__) || defined(__amd64__)
91111618cbSDoug Rabson 	wbinvd();
9259747216SDoug Rabson #endif
93111618cbSDoug Rabson }
9459747216SDoug Rabson 
9559747216SDoug Rabson u_int8_t
9659747216SDoug Rabson agp_find_caps(device_t dev)
9759747216SDoug Rabson {
9804d6a912SJohn Baldwin 	int capreg;
9959747216SDoug Rabson 
10059747216SDoug Rabson 
10104d6a912SJohn Baldwin 	if (pci_find_extcap(dev, PCIY_AGP, &capreg) != 0)
10204d6a912SJohn Baldwin 		capreg = 0;
10304d6a912SJohn Baldwin 	return (capreg);
10459747216SDoug Rabson }
10559747216SDoug Rabson 
10659747216SDoug Rabson /*
10759747216SDoug Rabson  * Find an AGP display device (if any).
10859747216SDoug Rabson  */
10959747216SDoug Rabson static device_t
11059747216SDoug Rabson agp_find_display(void)
11159747216SDoug Rabson {
11259747216SDoug Rabson 	devclass_t pci = devclass_find("pci");
11359747216SDoug Rabson 	device_t bus, dev = 0;
11459747216SDoug Rabson 	device_t *kids;
11559747216SDoug Rabson 	int busnum, numkids, i;
11659747216SDoug Rabson 
11759747216SDoug Rabson 	for (busnum = 0; busnum < devclass_get_maxunit(pci); busnum++) {
11859747216SDoug Rabson 		bus = devclass_get_device(pci, busnum);
11959747216SDoug Rabson 		if (!bus)
12059747216SDoug Rabson 			continue;
12159747216SDoug Rabson 		device_get_children(bus, &kids, &numkids);
12259747216SDoug Rabson 		for (i = 0; i < numkids; i++) {
12359747216SDoug Rabson 			dev = kids[i];
12459747216SDoug Rabson 			if (pci_get_class(dev) == PCIC_DISPLAY
12559747216SDoug Rabson 			    && pci_get_subclass(dev) == PCIS_DISPLAY_VGA)
12659747216SDoug Rabson 				if (agp_find_caps(dev)) {
12759747216SDoug Rabson 					free(kids, M_TEMP);
12859747216SDoug Rabson 					return dev;
12959747216SDoug Rabson 				}
13059747216SDoug Rabson 
13159747216SDoug Rabson 		}
13259747216SDoug Rabson 		free(kids, M_TEMP);
13359747216SDoug Rabson 	}
13459747216SDoug Rabson 
13559747216SDoug Rabson 	return 0;
13659747216SDoug Rabson }
13759747216SDoug Rabson 
13859747216SDoug Rabson struct agp_gatt *
13959747216SDoug Rabson agp_alloc_gatt(device_t dev)
14059747216SDoug Rabson {
14159747216SDoug Rabson 	u_int32_t apsize = AGP_GET_APERTURE(dev);
14259747216SDoug Rabson 	u_int32_t entries = apsize >> AGP_PAGE_SHIFT;
14359747216SDoug Rabson 	struct agp_gatt *gatt;
14459747216SDoug Rabson 
14559747216SDoug Rabson 	if (bootverbose)
14659747216SDoug Rabson 		device_printf(dev,
14759747216SDoug Rabson 			      "allocating GATT for aperture of size %dM\n",
14859747216SDoug Rabson 			      apsize / (1024*1024));
14959747216SDoug Rabson 
150a6cb9d8eSEric Anholt 	if (entries == 0) {
151a6cb9d8eSEric Anholt 		device_printf(dev, "bad aperture size\n");
152a6cb9d8eSEric Anholt 		return NULL;
153a6cb9d8eSEric Anholt 	}
154a6cb9d8eSEric Anholt 
15559747216SDoug Rabson 	gatt = malloc(sizeof(struct agp_gatt), M_AGP, M_NOWAIT);
15659747216SDoug Rabson 	if (!gatt)
15759747216SDoug Rabson 		return 0;
15859747216SDoug Rabson 
15959747216SDoug Rabson 	gatt->ag_entries = entries;
16059747216SDoug Rabson 	gatt->ag_virtual = contigmalloc(entries * sizeof(u_int32_t), M_AGP, 0,
16159747216SDoug Rabson 					0, ~0, PAGE_SIZE, 0);
16259747216SDoug Rabson 	if (!gatt->ag_virtual) {
16359747216SDoug Rabson 		if (bootverbose)
16459747216SDoug Rabson 			device_printf(dev, "contiguous allocation failed\n");
16559747216SDoug Rabson 		free(gatt, M_AGP);
16659747216SDoug Rabson 		return 0;
16759747216SDoug Rabson 	}
16859747216SDoug Rabson 	bzero(gatt->ag_virtual, entries * sizeof(u_int32_t));
16959747216SDoug Rabson 	gatt->ag_physical = vtophys((vm_offset_t) gatt->ag_virtual);
17059747216SDoug Rabson 	agp_flush_cache();
17159747216SDoug Rabson 
17259747216SDoug Rabson 	return gatt;
17359747216SDoug Rabson }
17459747216SDoug Rabson 
17559747216SDoug Rabson void
17659747216SDoug Rabson agp_free_gatt(struct agp_gatt *gatt)
17759747216SDoug Rabson {
17859747216SDoug Rabson 	contigfree(gatt->ag_virtual,
17959747216SDoug Rabson 		   gatt->ag_entries * sizeof(u_int32_t), M_AGP);
18059747216SDoug Rabson 	free(gatt, M_AGP);
18159747216SDoug Rabson }
18259747216SDoug Rabson 
1837370bc77SSeigo Tanimura static u_int agp_max[][2] = {
18459747216SDoug Rabson 	{0,	0},
18559747216SDoug Rabson 	{32,	4},
18659747216SDoug Rabson 	{64,	28},
18759747216SDoug Rabson 	{128,	96},
18859747216SDoug Rabson 	{256,	204},
18959747216SDoug Rabson 	{512,	440},
19059747216SDoug Rabson 	{1024,	942},
19159747216SDoug Rabson 	{2048,	1920},
19259747216SDoug Rabson 	{4096,	3932}
19359747216SDoug Rabson };
19459747216SDoug Rabson #define agp_max_size	(sizeof(agp_max) / sizeof(agp_max[0]))
19559747216SDoug Rabson 
196d450e052SEric Anholt /**
197d450e052SEric Anholt  * Sets the PCI resource which represents the AGP aperture.
198d450e052SEric Anholt  *
199d450e052SEric Anholt  * If not called, the default AGP aperture resource of AGP_APBASE will
200d450e052SEric Anholt  * be used.  Must be called before agp_generic_attach().
201d450e052SEric Anholt  */
202d450e052SEric Anholt void
203d450e052SEric Anholt agp_set_aperture_resource(device_t dev, int rid)
204d450e052SEric Anholt {
205d450e052SEric Anholt 	struct agp_softc *sc = device_get_softc(dev);
206d450e052SEric Anholt 
207d450e052SEric Anholt 	sc->as_aperture_rid = rid;
208d450e052SEric Anholt }
209d450e052SEric Anholt 
21059747216SDoug Rabson int
21159747216SDoug Rabson agp_generic_attach(device_t dev)
21259747216SDoug Rabson {
21359747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
214d450e052SEric Anholt 	int i;
2157370bc77SSeigo Tanimura 	u_int memsize;
21659747216SDoug Rabson 
21759747216SDoug Rabson 	/*
218d450e052SEric Anholt 	 * Find and map the aperture, RF_SHAREABLE for DRM but not RF_ACTIVE
219d450e052SEric Anholt 	 * because the kernel doesn't need to map it.
22059747216SDoug Rabson 	 */
221d450e052SEric Anholt 	if (sc->as_aperture_rid == 0)
222d450e052SEric Anholt 		sc->as_aperture_rid = AGP_APBASE;
223d450e052SEric Anholt 
224d450e052SEric Anholt 	sc->as_aperture = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
225d450e052SEric Anholt 	    &sc->as_aperture_rid, RF_SHAREABLE);
22659747216SDoug Rabson 	if (!sc->as_aperture)
22759747216SDoug Rabson 		return ENOMEM;
22859747216SDoug Rabson 
22959747216SDoug Rabson 	/*
23059747216SDoug Rabson 	 * Work out an upper bound for agp memory allocation. This
23159747216SDoug Rabson 	 * uses a heurisitc table from the Linux driver.
23259747216SDoug Rabson 	 */
23359747216SDoug Rabson 	memsize = ptoa(Maxmem) >> 20;
23459747216SDoug Rabson 	for (i = 0; i < agp_max_size; i++) {
23559747216SDoug Rabson 		if (memsize <= agp_max[i][0])
23659747216SDoug Rabson 			break;
23759747216SDoug Rabson 	}
23859747216SDoug Rabson 	if (i == agp_max_size) i = agp_max_size - 1;
23959747216SDoug Rabson 	sc->as_maxmem = agp_max[i][1] << 20U;
24059747216SDoug Rabson 
24159747216SDoug Rabson 	/*
24259747216SDoug Rabson 	 * The lock is used to prevent re-entry to
24359747216SDoug Rabson 	 * agp_generic_bind_memory() since that function can sleep.
24459747216SDoug Rabson 	 */
245d8a821e8SMaxime Henrion 	mtx_init(&sc->as_lock, "agp lock", NULL, MTX_DEF);
24659747216SDoug Rabson 
24759747216SDoug Rabson 	/*
24859747216SDoug Rabson 	 * Initialise stuff for the userland device.
24959747216SDoug Rabson 	 */
25059747216SDoug Rabson 	agp_devclass = devclass_find("agp");
25159747216SDoug Rabson 	TAILQ_INIT(&sc->as_memory);
25259747216SDoug Rabson 	sc->as_nextid = 1;
25359747216SDoug Rabson 
25459747216SDoug Rabson 	sc->as_devnode = make_dev(&agp_cdevsw,
25559747216SDoug Rabson 				  device_get_unit(dev),
25659747216SDoug Rabson 				  UID_ROOT,
25759747216SDoug Rabson 				  GID_WHEEL,
25859747216SDoug Rabson 				  0600,
25959747216SDoug Rabson 				  "agpgart");
26059747216SDoug Rabson 
26159747216SDoug Rabson 	return 0;
26259747216SDoug Rabson }
26359747216SDoug Rabson 
264f82a1d49SJohn Baldwin void
265f82a1d49SJohn Baldwin agp_free_cdev(device_t dev)
26659747216SDoug Rabson {
26759747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
2684c2546c1SJohn Baldwin 
2694c2546c1SJohn Baldwin 	destroy_dev(sc->as_devnode);
270f82a1d49SJohn Baldwin }
271f82a1d49SJohn Baldwin 
272f82a1d49SJohn Baldwin void
273f82a1d49SJohn Baldwin agp_free_res(device_t dev)
274f82a1d49SJohn Baldwin {
275f82a1d49SJohn Baldwin 	struct agp_softc *sc = device_get_softc(dev);
276f82a1d49SJohn Baldwin 
277d450e052SEric Anholt 	bus_release_resource(dev, SYS_RES_MEMORY, sc->as_aperture_rid,
278d450e052SEric Anholt 	    sc->as_aperture);
279d8a821e8SMaxime Henrion 	mtx_destroy(&sc->as_lock);
28059747216SDoug Rabson 	agp_flush_cache();
281f82a1d49SJohn Baldwin }
282f82a1d49SJohn Baldwin 
283f82a1d49SJohn Baldwin int
284f82a1d49SJohn Baldwin agp_generic_detach(device_t dev)
285f82a1d49SJohn Baldwin {
286f82a1d49SJohn Baldwin 
287f82a1d49SJohn Baldwin 	agp_free_cdev(dev);
288f82a1d49SJohn Baldwin 	agp_free_res(dev);
28959747216SDoug Rabson 	return 0;
29059747216SDoug Rabson }
29159747216SDoug Rabson 
292d450e052SEric Anholt /**
293d450e052SEric Anholt  * Default AGP aperture size detection which simply returns the size of
294d450e052SEric Anholt  * the aperture's PCI resource.
295d450e052SEric Anholt  */
296d450e052SEric Anholt int
297d450e052SEric Anholt agp_generic_get_aperture(device_t dev)
298d450e052SEric Anholt {
299d450e052SEric Anholt 	struct agp_softc *sc = device_get_softc(dev);
300d450e052SEric Anholt 
301d450e052SEric Anholt 	return rman_get_size(sc->as_aperture);
302d450e052SEric Anholt }
303d450e052SEric Anholt 
304d450e052SEric Anholt /**
305d450e052SEric Anholt  * Default AGP aperture size setting function, which simply doesn't allow
306d450e052SEric Anholt  * changes to resource size.
307d450e052SEric Anholt  */
308d450e052SEric Anholt int
309d450e052SEric Anholt agp_generic_set_aperture(device_t dev, u_int32_t aperture)
310d450e052SEric Anholt {
311d450e052SEric Anholt 	u_int32_t current_aperture;
312d450e052SEric Anholt 
313d450e052SEric Anholt 	current_aperture = AGP_GET_APERTURE(dev);
314d450e052SEric Anholt 	if (current_aperture != aperture)
315d450e052SEric Anholt 		return EINVAL;
316d450e052SEric Anholt 	else
317d450e052SEric Anholt 		return 0;
318d450e052SEric Anholt }
319d450e052SEric Anholt 
3209f9ccd20SJohn Baldwin /*
3219f9ccd20SJohn Baldwin  * This does the enable logic for v3, with the same topology
3229f9ccd20SJohn Baldwin  * restrictions as in place for v2 -- one bus, one device on the bus.
3239f9ccd20SJohn Baldwin  */
3249f9ccd20SJohn Baldwin static int
3259f9ccd20SJohn Baldwin agp_v3_enable(device_t dev, device_t mdev, u_int32_t mode)
32659747216SDoug Rabson {
32759747216SDoug Rabson 	u_int32_t tstatus, mstatus;
32859747216SDoug Rabson 	u_int32_t command;
3299f9ccd20SJohn Baldwin 	int rq, sba, fw, rate, arqsz, cal;
33059747216SDoug Rabson 
3319f9ccd20SJohn Baldwin 	tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4);
3329f9ccd20SJohn Baldwin 	mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4);
3339f9ccd20SJohn Baldwin 
3349f9ccd20SJohn Baldwin 	/* Set RQ to the min of mode, tstatus and mstatus */
3359f9ccd20SJohn Baldwin 	rq = AGP_MODE_GET_RQ(mode);
3369f9ccd20SJohn Baldwin 	if (AGP_MODE_GET_RQ(tstatus) < rq)
3379f9ccd20SJohn Baldwin 		rq = AGP_MODE_GET_RQ(tstatus);
3389f9ccd20SJohn Baldwin 	if (AGP_MODE_GET_RQ(mstatus) < rq)
3399f9ccd20SJohn Baldwin 		rq = AGP_MODE_GET_RQ(mstatus);
3409f9ccd20SJohn Baldwin 
3419f9ccd20SJohn Baldwin 	/*
3429f9ccd20SJohn Baldwin 	 * ARQSZ - Set the value to the maximum one.
3439f9ccd20SJohn Baldwin 	 * Don't allow the mode register to override values.
3449f9ccd20SJohn Baldwin 	 */
3459f9ccd20SJohn Baldwin 	arqsz = AGP_MODE_GET_ARQSZ(mode);
3469f9ccd20SJohn Baldwin 	if (AGP_MODE_GET_ARQSZ(tstatus) > rq)
3479f9ccd20SJohn Baldwin 		rq = AGP_MODE_GET_ARQSZ(tstatus);
3489f9ccd20SJohn Baldwin 	if (AGP_MODE_GET_ARQSZ(mstatus) > rq)
3499f9ccd20SJohn Baldwin 		rq = AGP_MODE_GET_ARQSZ(mstatus);
3509f9ccd20SJohn Baldwin 
3519f9ccd20SJohn Baldwin 	/* Calibration cycle - don't allow override by mode register */
3529f9ccd20SJohn Baldwin 	cal = AGP_MODE_GET_CAL(tstatus);
3539f9ccd20SJohn Baldwin 	if (AGP_MODE_GET_CAL(mstatus) < cal)
3549f9ccd20SJohn Baldwin 		cal = AGP_MODE_GET_CAL(mstatus);
3559f9ccd20SJohn Baldwin 
3569f9ccd20SJohn Baldwin 	/* SBA must be supported for AGP v3. */
3579f9ccd20SJohn Baldwin 	sba = 1;
3589f9ccd20SJohn Baldwin 
3599f9ccd20SJohn Baldwin 	/* Set FW if all three support it. */
3609f9ccd20SJohn Baldwin 	fw = (AGP_MODE_GET_FW(tstatus)
3619f9ccd20SJohn Baldwin 	       & AGP_MODE_GET_FW(mstatus)
3629f9ccd20SJohn Baldwin 	       & AGP_MODE_GET_FW(mode));
3639f9ccd20SJohn Baldwin 
3649f9ccd20SJohn Baldwin 	/* Figure out the max rate */
3659f9ccd20SJohn Baldwin 	rate = (AGP_MODE_GET_RATE(tstatus)
3669f9ccd20SJohn Baldwin 		& AGP_MODE_GET_RATE(mstatus)
3679f9ccd20SJohn Baldwin 		& AGP_MODE_GET_RATE(mode));
3689f9ccd20SJohn Baldwin 	if (rate & AGP_MODE_V3_RATE_8x)
3699f9ccd20SJohn Baldwin 		rate = AGP_MODE_V3_RATE_8x;
3709f9ccd20SJohn Baldwin 	else
3719f9ccd20SJohn Baldwin 		rate = AGP_MODE_V3_RATE_4x;
3729f9ccd20SJohn Baldwin 	if (bootverbose)
3739f9ccd20SJohn Baldwin 		device_printf(dev, "Setting AGP v3 mode %d\n", rate * 4);
3749f9ccd20SJohn Baldwin 
3759f9ccd20SJohn Baldwin 	pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, 0, 4);
3769f9ccd20SJohn Baldwin 
3779f9ccd20SJohn Baldwin 	/* Construct the new mode word and tell the hardware */
37898935c58SJung-uk Kim 	command = 0;
3799f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_RQ(0, rq);
3809f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_ARQSZ(command, arqsz);
3819f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_CAL(command, cal);
3829f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_SBA(command, sba);
3839f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_FW(command, fw);
3849f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_RATE(command, rate);
38598935c58SJung-uk Kim 	command = AGP_MODE_SET_MODE_3(command, 1);
3869f9ccd20SJohn Baldwin 	command = AGP_MODE_SET_AGP(command, 1);
3879f9ccd20SJohn Baldwin 	pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, command, 4);
3889f9ccd20SJohn Baldwin 	pci_write_config(mdev, agp_find_caps(mdev) + AGP_COMMAND, command, 4);
3899f9ccd20SJohn Baldwin 
3909f9ccd20SJohn Baldwin 	return 0;
39159747216SDoug Rabson }
39259747216SDoug Rabson 
3939f9ccd20SJohn Baldwin static int
3949f9ccd20SJohn Baldwin agp_v2_enable(device_t dev, device_t mdev, u_int32_t mode)
3959f9ccd20SJohn Baldwin {
3969f9ccd20SJohn Baldwin 	u_int32_t tstatus, mstatus;
3979f9ccd20SJohn Baldwin 	u_int32_t command;
3989f9ccd20SJohn Baldwin 	int rq, sba, fw, rate;
3999f9ccd20SJohn Baldwin 
40059747216SDoug Rabson 	tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4);
40159747216SDoug Rabson 	mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4);
40259747216SDoug Rabson 
40359747216SDoug Rabson 	/* Set RQ to the min of mode, tstatus and mstatus */
40459747216SDoug Rabson 	rq = AGP_MODE_GET_RQ(mode);
40559747216SDoug Rabson 	if (AGP_MODE_GET_RQ(tstatus) < rq)
40659747216SDoug Rabson 		rq = AGP_MODE_GET_RQ(tstatus);
40759747216SDoug Rabson 	if (AGP_MODE_GET_RQ(mstatus) < rq)
40859747216SDoug Rabson 		rq = AGP_MODE_GET_RQ(mstatus);
40959747216SDoug Rabson 
41059747216SDoug Rabson 	/* Set SBA if all three can deal with SBA */
41159747216SDoug Rabson 	sba = (AGP_MODE_GET_SBA(tstatus)
41259747216SDoug Rabson 	       & AGP_MODE_GET_SBA(mstatus)
41359747216SDoug Rabson 	       & AGP_MODE_GET_SBA(mode));
41459747216SDoug Rabson 
41559747216SDoug Rabson 	/* Similar for FW */
41659747216SDoug Rabson 	fw = (AGP_MODE_GET_FW(tstatus)
41759747216SDoug Rabson 	       & AGP_MODE_GET_FW(mstatus)
41859747216SDoug Rabson 	       & AGP_MODE_GET_FW(mode));
41959747216SDoug Rabson 
42059747216SDoug Rabson 	/* Figure out the max rate */
42159747216SDoug Rabson 	rate = (AGP_MODE_GET_RATE(tstatus)
42259747216SDoug Rabson 		& AGP_MODE_GET_RATE(mstatus)
42359747216SDoug Rabson 		& AGP_MODE_GET_RATE(mode));
4249f9ccd20SJohn Baldwin 	if (rate & AGP_MODE_V2_RATE_4x)
4259f9ccd20SJohn Baldwin 		rate = AGP_MODE_V2_RATE_4x;
4269f9ccd20SJohn Baldwin 	else if (rate & AGP_MODE_V2_RATE_2x)
4279f9ccd20SJohn Baldwin 		rate = AGP_MODE_V2_RATE_2x;
42859747216SDoug Rabson 	else
4299f9ccd20SJohn Baldwin 		rate = AGP_MODE_V2_RATE_1x;
4309f9ccd20SJohn Baldwin 	if (bootverbose)
4319f9ccd20SJohn Baldwin 		device_printf(dev, "Setting AGP v2 mode %d\n", rate);
43259747216SDoug Rabson 
43359747216SDoug Rabson 	/* Construct the new mode word and tell the hardware */
43498935c58SJung-uk Kim 	command = 0;
43559747216SDoug Rabson 	command = AGP_MODE_SET_RQ(0, rq);
43659747216SDoug Rabson 	command = AGP_MODE_SET_SBA(command, sba);
43759747216SDoug Rabson 	command = AGP_MODE_SET_FW(command, fw);
43859747216SDoug Rabson 	command = AGP_MODE_SET_RATE(command, rate);
43959747216SDoug Rabson 	command = AGP_MODE_SET_AGP(command, 1);
44059747216SDoug Rabson 	pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, command, 4);
44159747216SDoug Rabson 	pci_write_config(mdev, agp_find_caps(mdev) + AGP_COMMAND, command, 4);
44259747216SDoug Rabson 
44359747216SDoug Rabson 	return 0;
44459747216SDoug Rabson }
44559747216SDoug Rabson 
4469f9ccd20SJohn Baldwin int
4479f9ccd20SJohn Baldwin agp_generic_enable(device_t dev, u_int32_t mode)
4489f9ccd20SJohn Baldwin {
4499f9ccd20SJohn Baldwin 	device_t mdev = agp_find_display();
4509f9ccd20SJohn Baldwin 	u_int32_t tstatus, mstatus;
4519f9ccd20SJohn Baldwin 
4529f9ccd20SJohn Baldwin 	if (!mdev) {
4539f9ccd20SJohn Baldwin 		AGP_DPF("can't find display\n");
4549f9ccd20SJohn Baldwin 		return ENXIO;
4559f9ccd20SJohn Baldwin 	}
4569f9ccd20SJohn Baldwin 
4579f9ccd20SJohn Baldwin 	tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4);
4589f9ccd20SJohn Baldwin 	mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4);
4599f9ccd20SJohn Baldwin 
4609f9ccd20SJohn Baldwin 	/*
4619f9ccd20SJohn Baldwin 	 * Check display and bridge for AGP v3 support.  AGP v3 allows
4629f9ccd20SJohn Baldwin 	 * more variety in topology than v2, e.g. multiple AGP devices
4639f9ccd20SJohn Baldwin 	 * attached to one bridge, or multiple AGP bridges in one
4649f9ccd20SJohn Baldwin 	 * system.  This doesn't attempt to address those situations,
4659f9ccd20SJohn Baldwin 	 * but should work fine for a classic single AGP slot system
4669f9ccd20SJohn Baldwin 	 * with AGP v3.
4679f9ccd20SJohn Baldwin 	 */
46898935c58SJung-uk Kim 	if (AGP_MODE_GET_MODE_3(mode) &&
46998935c58SJung-uk Kim 	    AGP_MODE_GET_MODE_3(tstatus) &&
47098935c58SJung-uk Kim 	    AGP_MODE_GET_MODE_3(mstatus))
4719f9ccd20SJohn Baldwin 		return (agp_v3_enable(dev, mdev, mode));
4729f9ccd20SJohn Baldwin 	else
4739f9ccd20SJohn Baldwin 		return (agp_v2_enable(dev, mdev, mode));
4749f9ccd20SJohn Baldwin }
4759f9ccd20SJohn Baldwin 
47659747216SDoug Rabson struct agp_memory *
47759747216SDoug Rabson agp_generic_alloc_memory(device_t dev, int type, vm_size_t size)
47859747216SDoug Rabson {
47959747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
48059747216SDoug Rabson 	struct agp_memory *mem;
48159747216SDoug Rabson 
48259747216SDoug Rabson 	if ((size & (AGP_PAGE_SIZE - 1)) != 0)
48359747216SDoug Rabson 		return 0;
48459747216SDoug Rabson 
48559747216SDoug Rabson 	if (sc->as_allocated + size > sc->as_maxmem)
48659747216SDoug Rabson 		return 0;
48759747216SDoug Rabson 
488e547d6fdSDoug Rabson 	if (type != 0) {
489e547d6fdSDoug Rabson 		printf("agp_generic_alloc_memory: unsupported type %d\n",
490e547d6fdSDoug Rabson 		       type);
491e547d6fdSDoug Rabson 		return 0;
492e547d6fdSDoug Rabson 	}
493e547d6fdSDoug Rabson 
494a163d034SWarner Losh 	mem = malloc(sizeof *mem, M_AGP, M_WAITOK);
49559747216SDoug Rabson 	mem->am_id = sc->as_nextid++;
49659747216SDoug Rabson 	mem->am_size = size;
497e547d6fdSDoug Rabson 	mem->am_type = 0;
49859747216SDoug Rabson 	mem->am_obj = vm_object_allocate(OBJT_DEFAULT, atop(round_page(size)));
49959747216SDoug Rabson 	mem->am_physical = 0;
50059747216SDoug Rabson 	mem->am_offset = 0;
50159747216SDoug Rabson 	mem->am_is_bound = 0;
50259747216SDoug Rabson 	TAILQ_INSERT_TAIL(&sc->as_memory, mem, am_link);
50359747216SDoug Rabson 	sc->as_allocated += size;
50459747216SDoug Rabson 
50559747216SDoug Rabson 	return mem;
50659747216SDoug Rabson }
50759747216SDoug Rabson 
50859747216SDoug Rabson int
50959747216SDoug Rabson agp_generic_free_memory(device_t dev, struct agp_memory *mem)
51059747216SDoug Rabson {
51159747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
51259747216SDoug Rabson 
51359747216SDoug Rabson 	if (mem->am_is_bound)
51459747216SDoug Rabson 		return EBUSY;
51559747216SDoug Rabson 
51659747216SDoug Rabson 	sc->as_allocated -= mem->am_size;
51759747216SDoug Rabson 	TAILQ_REMOVE(&sc->as_memory, mem, am_link);
51859747216SDoug Rabson 	vm_object_deallocate(mem->am_obj);
51959747216SDoug Rabson 	free(mem, M_AGP);
52059747216SDoug Rabson 	return 0;
52159747216SDoug Rabson }
52259747216SDoug Rabson 
52359747216SDoug Rabson int
52459747216SDoug Rabson agp_generic_bind_memory(device_t dev, struct agp_memory *mem,
52559747216SDoug Rabson 			vm_offset_t offset)
52659747216SDoug Rabson {
52759747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
52859747216SDoug Rabson 	vm_offset_t i, j, k;
52959747216SDoug Rabson 	vm_page_t m;
53059747216SDoug Rabson 	int error;
53159747216SDoug Rabson 
532eb325974SMaxime Henrion 	/* Do some sanity checks first. */
533eb325974SMaxime Henrion 	if (offset < 0 || (offset & (AGP_PAGE_SIZE - 1)) != 0 ||
534eb325974SMaxime Henrion 	    offset + mem->am_size > AGP_GET_APERTURE(dev)) {
53559747216SDoug Rabson 		device_printf(dev, "binding memory at bad offset %#x\n",
53659747216SDoug Rabson 		    (int)offset);
53759747216SDoug Rabson 		return EINVAL;
53859747216SDoug Rabson 	}
53959747216SDoug Rabson 
54059747216SDoug Rabson 	/*
541eb325974SMaxime Henrion 	 * Allocate the pages early, before acquiring the lock,
542eb325974SMaxime Henrion 	 * because vm_page_grab() used with VM_ALLOC_RETRY may
543eb325974SMaxime Henrion 	 * block and we can't hold a mutex while blocking.
54459747216SDoug Rabson 	 */
54591dd9693SAlan Cox 	VM_OBJECT_LOCK(mem->am_obj);
54659747216SDoug Rabson 	for (i = 0; i < mem->am_size; i += PAGE_SIZE) {
54759747216SDoug Rabson 		/*
54859747216SDoug Rabson 		 * Find a page from the object and wire it
54959747216SDoug Rabson 		 * down. This page will be mapped using one or more
55059747216SDoug Rabson 		 * entries in the GATT (assuming that PAGE_SIZE >=
55159747216SDoug Rabson 		 * AGP_PAGE_SIZE. If this is the first call to bind,
55259747216SDoug Rabson 		 * the pages will be allocated and zeroed.
55359747216SDoug Rabson 		 */
55459747216SDoug Rabson 		m = vm_page_grab(mem->am_obj, OFF_TO_IDX(i),
555fab965bfSAlan Cox 		    VM_ALLOC_WIRED | VM_ALLOC_ZERO | VM_ALLOC_RETRY);
55659747216SDoug Rabson 		AGP_DPF("found page pa=%#x\n", VM_PAGE_TO_PHYS(m));
557eb325974SMaxime Henrion 	}
55891dd9693SAlan Cox 	VM_OBJECT_UNLOCK(mem->am_obj);
559eb325974SMaxime Henrion 
560eb325974SMaxime Henrion 	mtx_lock(&sc->as_lock);
561eb325974SMaxime Henrion 
562eb325974SMaxime Henrion 	if (mem->am_is_bound) {
563eb325974SMaxime Henrion 		device_printf(dev, "memory already bound\n");
564eb325974SMaxime Henrion 		error = EINVAL;
56591dd9693SAlan Cox 		VM_OBJECT_LOCK(mem->am_obj);
566eb325974SMaxime Henrion 		goto bad;
567eb325974SMaxime Henrion 	}
568eb325974SMaxime Henrion 
569eb325974SMaxime Henrion 	/*
570eb325974SMaxime Henrion 	 * Bind the individual pages and flush the chipset's
571eb325974SMaxime Henrion 	 * TLB.
572eb325974SMaxime Henrion 	 */
573eb325974SMaxime Henrion 	VM_OBJECT_LOCK(mem->am_obj);
57491dd9693SAlan Cox 	for (i = 0; i < mem->am_size; i += PAGE_SIZE) {
575eb325974SMaxime Henrion 		m = vm_page_lookup(mem->am_obj, OFF_TO_IDX(i));
57659747216SDoug Rabson 
57759747216SDoug Rabson 		/*
57859747216SDoug Rabson 		 * Install entries in the GATT, making sure that if
57959747216SDoug Rabson 		 * AGP_PAGE_SIZE < PAGE_SIZE and mem->am_size is not
58059747216SDoug Rabson 		 * aligned to PAGE_SIZE, we don't modify too many GATT
58159747216SDoug Rabson 		 * entries.
58259747216SDoug Rabson 		 */
58359747216SDoug Rabson 		for (j = 0; j < PAGE_SIZE && i + j < mem->am_size;
58459747216SDoug Rabson 		     j += AGP_PAGE_SIZE) {
58559747216SDoug Rabson 			vm_offset_t pa = VM_PAGE_TO_PHYS(m) + j;
58659747216SDoug Rabson 			AGP_DPF("binding offset %#x to pa %#x\n",
58759747216SDoug Rabson 				offset + i + j, pa);
58859747216SDoug Rabson 			error = AGP_BIND_PAGE(dev, offset + i + j, pa);
58959747216SDoug Rabson 			if (error) {
59059747216SDoug Rabson 				/*
59159747216SDoug Rabson 				 * Bail out. Reverse all the mappings
59259747216SDoug Rabson 				 * and unwire the pages.
59359747216SDoug Rabson 				 */
59459747216SDoug Rabson 				vm_page_wakeup(m);
59559747216SDoug Rabson 				for (k = 0; k < i + j; k += AGP_PAGE_SIZE)
59659747216SDoug Rabson 					AGP_UNBIND_PAGE(dev, offset + k);
597eb325974SMaxime Henrion 				goto bad;
59859747216SDoug Rabson 			}
59959747216SDoug Rabson 		}
60059747216SDoug Rabson 		vm_page_wakeup(m);
60159747216SDoug Rabson 	}
60291dd9693SAlan Cox 	VM_OBJECT_UNLOCK(mem->am_obj);
60359747216SDoug Rabson 
60459747216SDoug Rabson 	/*
60559747216SDoug Rabson 	 * Flush the cpu cache since we are providing a new mapping
60659747216SDoug Rabson 	 * for these pages.
60759747216SDoug Rabson 	 */
60859747216SDoug Rabson 	agp_flush_cache();
60959747216SDoug Rabson 
61059747216SDoug Rabson 	/*
61159747216SDoug Rabson 	 * Make sure the chipset gets the new mappings.
61259747216SDoug Rabson 	 */
61359747216SDoug Rabson 	AGP_FLUSH_TLB(dev);
61459747216SDoug Rabson 
61559747216SDoug Rabson 	mem->am_offset = offset;
61659747216SDoug Rabson 	mem->am_is_bound = 1;
61759747216SDoug Rabson 
618d8a821e8SMaxime Henrion 	mtx_unlock(&sc->as_lock);
61959747216SDoug Rabson 
62059747216SDoug Rabson 	return 0;
621eb325974SMaxime Henrion bad:
622eb325974SMaxime Henrion 	mtx_unlock(&sc->as_lock);
62391dd9693SAlan Cox 	VM_OBJECT_LOCK_ASSERT(mem->am_obj, MA_OWNED);
624eb325974SMaxime Henrion 	for (i = 0; i < mem->am_size; i += PAGE_SIZE) {
625eb325974SMaxime Henrion 		m = vm_page_lookup(mem->am_obj, OFF_TO_IDX(i));
626eb325974SMaxime Henrion 		vm_page_lock_queues();
627eb325974SMaxime Henrion 		vm_page_unwire(m, 0);
628eb325974SMaxime Henrion 		vm_page_unlock_queues();
629eb325974SMaxime Henrion 	}
630eb325974SMaxime Henrion 	VM_OBJECT_UNLOCK(mem->am_obj);
631eb325974SMaxime Henrion 
632eb325974SMaxime Henrion 	return error;
63359747216SDoug Rabson }
63459747216SDoug Rabson 
63559747216SDoug Rabson int
63659747216SDoug Rabson agp_generic_unbind_memory(device_t dev, struct agp_memory *mem)
63759747216SDoug Rabson {
63859747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
63959747216SDoug Rabson 	vm_page_t m;
64059747216SDoug Rabson 	int i;
64159747216SDoug Rabson 
642d8a821e8SMaxime Henrion 	mtx_lock(&sc->as_lock);
64359747216SDoug Rabson 
64459747216SDoug Rabson 	if (!mem->am_is_bound) {
64559747216SDoug Rabson 		device_printf(dev, "memory is not bound\n");
646d8a821e8SMaxime Henrion 		mtx_unlock(&sc->as_lock);
64759747216SDoug Rabson 		return EINVAL;
64859747216SDoug Rabson 	}
64959747216SDoug Rabson 
65059747216SDoug Rabson 
65159747216SDoug Rabson 	/*
65259747216SDoug Rabson 	 * Unbind the individual pages and flush the chipset's
65359747216SDoug Rabson 	 * TLB. Unwire the pages so they can be swapped.
65459747216SDoug Rabson 	 */
65559747216SDoug Rabson 	for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE)
65659747216SDoug Rabson 		AGP_UNBIND_PAGE(dev, mem->am_offset + i);
657f873ed03SAlan Cox 	VM_OBJECT_LOCK(mem->am_obj);
65859747216SDoug Rabson 	for (i = 0; i < mem->am_size; i += PAGE_SIZE) {
65959747216SDoug Rabson 		m = vm_page_lookup(mem->am_obj, atop(i));
6601f545269SAlan Cox 		vm_page_lock_queues();
66159747216SDoug Rabson 		vm_page_unwire(m, 0);
6621f545269SAlan Cox 		vm_page_unlock_queues();
66359747216SDoug Rabson 	}
664f873ed03SAlan Cox 	VM_OBJECT_UNLOCK(mem->am_obj);
66559747216SDoug Rabson 
66659747216SDoug Rabson 	agp_flush_cache();
66759747216SDoug Rabson 	AGP_FLUSH_TLB(dev);
66859747216SDoug Rabson 
66959747216SDoug Rabson 	mem->am_offset = 0;
67059747216SDoug Rabson 	mem->am_is_bound = 0;
67159747216SDoug Rabson 
672d8a821e8SMaxime Henrion 	mtx_unlock(&sc->as_lock);
67359747216SDoug Rabson 
67459747216SDoug Rabson 	return 0;
67559747216SDoug Rabson }
67659747216SDoug Rabson 
67759747216SDoug Rabson /* Helper functions for implementing user/kernel api */
67859747216SDoug Rabson 
67959747216SDoug Rabson static int
68059747216SDoug Rabson agp_acquire_helper(device_t dev, enum agp_acquire_state state)
68159747216SDoug Rabson {
68259747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
68359747216SDoug Rabson 
68459747216SDoug Rabson 	if (sc->as_state != AGP_ACQUIRE_FREE)
68559747216SDoug Rabson 		return EBUSY;
68659747216SDoug Rabson 	sc->as_state = state;
68759747216SDoug Rabson 
68859747216SDoug Rabson 	return 0;
68959747216SDoug Rabson }
69059747216SDoug Rabson 
69159747216SDoug Rabson static int
69259747216SDoug Rabson agp_release_helper(device_t dev, enum agp_acquire_state state)
69359747216SDoug Rabson {
69459747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
69559747216SDoug Rabson 
69659747216SDoug Rabson 	if (sc->as_state == AGP_ACQUIRE_FREE)
69759747216SDoug Rabson 		return 0;
69859747216SDoug Rabson 
69959747216SDoug Rabson 	if (sc->as_state != state)
70059747216SDoug Rabson 		return EBUSY;
70159747216SDoug Rabson 
70259747216SDoug Rabson 	sc->as_state = AGP_ACQUIRE_FREE;
70359747216SDoug Rabson 	return 0;
70459747216SDoug Rabson }
70559747216SDoug Rabson 
70659747216SDoug Rabson static struct agp_memory *
70759747216SDoug Rabson agp_find_memory(device_t dev, int id)
70859747216SDoug Rabson {
70959747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
71059747216SDoug Rabson 	struct agp_memory *mem;
71159747216SDoug Rabson 
71259747216SDoug Rabson 	AGP_DPF("searching for memory block %d\n", id);
71359747216SDoug Rabson 	TAILQ_FOREACH(mem, &sc->as_memory, am_link) {
71459747216SDoug Rabson 		AGP_DPF("considering memory block %d\n", mem->am_id);
71559747216SDoug Rabson 		if (mem->am_id == id)
71659747216SDoug Rabson 			return mem;
71759747216SDoug Rabson 	}
71859747216SDoug Rabson 	return 0;
71959747216SDoug Rabson }
72059747216SDoug Rabson 
72159747216SDoug Rabson /* Implementation of the userland ioctl api */
72259747216SDoug Rabson 
72359747216SDoug Rabson static int
72459747216SDoug Rabson agp_info_user(device_t dev, agp_info *info)
72559747216SDoug Rabson {
72659747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
72759747216SDoug Rabson 
72859747216SDoug Rabson 	bzero(info, sizeof *info);
72959747216SDoug Rabson 	info->bridge_id = pci_get_devid(dev);
73059747216SDoug Rabson 	info->agp_mode =
73159747216SDoug Rabson 	    pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4);
73259747216SDoug Rabson 	info->aper_base = rman_get_start(sc->as_aperture);
73359747216SDoug Rabson 	info->aper_size = AGP_GET_APERTURE(dev) >> 20;
73459747216SDoug Rabson 	info->pg_total = info->pg_system = sc->as_maxmem >> AGP_PAGE_SHIFT;
73559747216SDoug Rabson 	info->pg_used = sc->as_allocated >> AGP_PAGE_SHIFT;
73659747216SDoug Rabson 
73759747216SDoug Rabson 	return 0;
73859747216SDoug Rabson }
73959747216SDoug Rabson 
74059747216SDoug Rabson static int
74159747216SDoug Rabson agp_setup_user(device_t dev, agp_setup *setup)
74259747216SDoug Rabson {
74359747216SDoug Rabson 	return AGP_ENABLE(dev, setup->agp_mode);
74459747216SDoug Rabson }
74559747216SDoug Rabson 
74659747216SDoug Rabson static int
74759747216SDoug Rabson agp_allocate_user(device_t dev, agp_allocate *alloc)
74859747216SDoug Rabson {
74959747216SDoug Rabson 	struct agp_memory *mem;
75059747216SDoug Rabson 
75159747216SDoug Rabson 	mem = AGP_ALLOC_MEMORY(dev,
75259747216SDoug Rabson 			       alloc->type,
75359747216SDoug Rabson 			       alloc->pg_count << AGP_PAGE_SHIFT);
754e547d6fdSDoug Rabson 	if (mem) {
75559747216SDoug Rabson 		alloc->key = mem->am_id;
75659747216SDoug Rabson 		alloc->physical = mem->am_physical;
75759747216SDoug Rabson 		return 0;
758e547d6fdSDoug Rabson 	} else {
759e547d6fdSDoug Rabson 		return ENOMEM;
760e547d6fdSDoug Rabson 	}
76159747216SDoug Rabson }
76259747216SDoug Rabson 
76359747216SDoug Rabson static int
76459747216SDoug Rabson agp_deallocate_user(device_t dev, int id)
76559747216SDoug Rabson {
76659747216SDoug Rabson 	struct agp_memory *mem = agp_find_memory(dev, id);;
76759747216SDoug Rabson 
76859747216SDoug Rabson 	if (mem) {
76959747216SDoug Rabson 		AGP_FREE_MEMORY(dev, mem);
77059747216SDoug Rabson 		return 0;
77159747216SDoug Rabson 	} else {
77259747216SDoug Rabson 		return ENOENT;
77359747216SDoug Rabson 	}
77459747216SDoug Rabson }
77559747216SDoug Rabson 
77659747216SDoug Rabson static int
77759747216SDoug Rabson agp_bind_user(device_t dev, agp_bind *bind)
77859747216SDoug Rabson {
77959747216SDoug Rabson 	struct agp_memory *mem = agp_find_memory(dev, bind->key);
78059747216SDoug Rabson 
78159747216SDoug Rabson 	if (!mem)
78259747216SDoug Rabson 		return ENOENT;
78359747216SDoug Rabson 
78459747216SDoug Rabson 	return AGP_BIND_MEMORY(dev, mem, bind->pg_start << AGP_PAGE_SHIFT);
78559747216SDoug Rabson }
78659747216SDoug Rabson 
78759747216SDoug Rabson static int
78859747216SDoug Rabson agp_unbind_user(device_t dev, agp_unbind *unbind)
78959747216SDoug Rabson {
79059747216SDoug Rabson 	struct agp_memory *mem = agp_find_memory(dev, unbind->key);
79159747216SDoug Rabson 
79259747216SDoug Rabson 	if (!mem)
79359747216SDoug Rabson 		return ENOENT;
79459747216SDoug Rabson 
79559747216SDoug Rabson 	return AGP_UNBIND_MEMORY(dev, mem);
79659747216SDoug Rabson }
79759747216SDoug Rabson 
79859747216SDoug Rabson static int
79989c9c53dSPoul-Henning Kamp agp_open(struct cdev *kdev, int oflags, int devtype, struct thread *td)
80059747216SDoug Rabson {
80159747216SDoug Rabson 	device_t dev = KDEV2DEV(kdev);
80259747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
80359747216SDoug Rabson 
80459747216SDoug Rabson 	if (!sc->as_isopen) {
80559747216SDoug Rabson 		sc->as_isopen = 1;
80659747216SDoug Rabson 		device_busy(dev);
80759747216SDoug Rabson 	}
80859747216SDoug Rabson 
80959747216SDoug Rabson 	return 0;
81059747216SDoug Rabson }
81159747216SDoug Rabson 
81259747216SDoug Rabson static int
81389c9c53dSPoul-Henning Kamp agp_close(struct cdev *kdev, int fflag, int devtype, struct thread *td)
81459747216SDoug Rabson {
81559747216SDoug Rabson 	device_t dev = KDEV2DEV(kdev);
81659747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
8173e0cee70SRuslan Ermilov 	struct agp_memory *mem;
81859747216SDoug Rabson 
81959747216SDoug Rabson 	/*
82059747216SDoug Rabson 	 * Clear the GATT and force release on last close
82159747216SDoug Rabson 	 */
8223e0cee70SRuslan Ermilov 	while ((mem = TAILQ_FIRST(&sc->as_memory)) != 0) {
8233e0cee70SRuslan Ermilov 		if (mem->am_is_bound)
8243e0cee70SRuslan Ermilov 			AGP_UNBIND_MEMORY(dev, mem);
8253e0cee70SRuslan Ermilov 		AGP_FREE_MEMORY(dev, mem);
8263e0cee70SRuslan Ermilov 	}
82759747216SDoug Rabson 	if (sc->as_state == AGP_ACQUIRE_USER)
82859747216SDoug Rabson 		agp_release_helper(dev, AGP_ACQUIRE_USER);
82959747216SDoug Rabson 	sc->as_isopen = 0;
83059747216SDoug Rabson 	device_unbusy(dev);
83159747216SDoug Rabson 
83259747216SDoug Rabson 	return 0;
83359747216SDoug Rabson }
83459747216SDoug Rabson 
83559747216SDoug Rabson static int
83689c9c53dSPoul-Henning Kamp agp_ioctl(struct cdev *kdev, u_long cmd, caddr_t data, int fflag, struct thread *td)
83759747216SDoug Rabson {
83859747216SDoug Rabson 	device_t dev = KDEV2DEV(kdev);
83959747216SDoug Rabson 
84059747216SDoug Rabson 	switch (cmd) {
84159747216SDoug Rabson 	case AGPIOC_INFO:
84259747216SDoug Rabson 		return agp_info_user(dev, (agp_info *) data);
84359747216SDoug Rabson 
84459747216SDoug Rabson 	case AGPIOC_ACQUIRE:
84559747216SDoug Rabson 		return agp_acquire_helper(dev, AGP_ACQUIRE_USER);
84659747216SDoug Rabson 
84759747216SDoug Rabson 	case AGPIOC_RELEASE:
84859747216SDoug Rabson 		return agp_release_helper(dev, AGP_ACQUIRE_USER);
84959747216SDoug Rabson 
85059747216SDoug Rabson 	case AGPIOC_SETUP:
85159747216SDoug Rabson 		return agp_setup_user(dev, (agp_setup *)data);
85259747216SDoug Rabson 
85359747216SDoug Rabson 	case AGPIOC_ALLOCATE:
85459747216SDoug Rabson 		return agp_allocate_user(dev, (agp_allocate *)data);
85559747216SDoug Rabson 
85659747216SDoug Rabson 	case AGPIOC_DEALLOCATE:
85759747216SDoug Rabson 		return agp_deallocate_user(dev, *(int *) data);
85859747216SDoug Rabson 
85959747216SDoug Rabson 	case AGPIOC_BIND:
86059747216SDoug Rabson 		return agp_bind_user(dev, (agp_bind *)data);
86159747216SDoug Rabson 
86259747216SDoug Rabson 	case AGPIOC_UNBIND:
86359747216SDoug Rabson 		return agp_unbind_user(dev, (agp_unbind *)data);
86459747216SDoug Rabson 
86559747216SDoug Rabson 	}
86659747216SDoug Rabson 
86759747216SDoug Rabson 	return EINVAL;
86859747216SDoug Rabson }
86959747216SDoug Rabson 
87059747216SDoug Rabson static int
87189c9c53dSPoul-Henning Kamp agp_mmap(struct cdev *kdev, vm_offset_t offset, vm_paddr_t *paddr, int prot)
87259747216SDoug Rabson {
87359747216SDoug Rabson 	device_t dev = KDEV2DEV(kdev);
87459747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
87559747216SDoug Rabson 
87659747216SDoug Rabson 	if (offset > AGP_GET_APERTURE(dev))
87759747216SDoug Rabson 		return -1;
87807159f9cSMaxime Henrion 	*paddr = rman_get_start(sc->as_aperture) + offset;
87907159f9cSMaxime Henrion 	return 0;
88059747216SDoug Rabson }
88159747216SDoug Rabson 
88259747216SDoug Rabson /* Implementation of the kernel api */
88359747216SDoug Rabson 
88459747216SDoug Rabson device_t
88559747216SDoug Rabson agp_find_device()
88659747216SDoug Rabson {
8872971d7abSJohn Baldwin 	device_t *children, child;
888c8d81a41SJohn Baldwin 	int i, count;
889c8d81a41SJohn Baldwin 
89059747216SDoug Rabson 	if (!agp_devclass)
891c8d81a41SJohn Baldwin 		return NULL;
892c8d81a41SJohn Baldwin 	if (devclass_get_devices(agp_devclass, &children, &count) != 0)
893c8d81a41SJohn Baldwin 		return NULL;
8942971d7abSJohn Baldwin 	child = NULL;
895c8d81a41SJohn Baldwin 	for (i = 0; i < count; i++) {
8962971d7abSJohn Baldwin 		if (device_is_attached(children[i])) {
8972971d7abSJohn Baldwin 			child = children[i];
8982971d7abSJohn Baldwin 			break;
899c8d81a41SJohn Baldwin 		}
9002971d7abSJohn Baldwin 	}
9012971d7abSJohn Baldwin 	free(children, M_TEMP);
9022971d7abSJohn Baldwin 	return child;
90359747216SDoug Rabson }
90459747216SDoug Rabson 
90559747216SDoug Rabson enum agp_acquire_state
90659747216SDoug Rabson agp_state(device_t dev)
90759747216SDoug Rabson {
90859747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
90959747216SDoug Rabson 	return sc->as_state;
91059747216SDoug Rabson }
91159747216SDoug Rabson 
91259747216SDoug Rabson void
91359747216SDoug Rabson agp_get_info(device_t dev, struct agp_info *info)
91459747216SDoug Rabson {
91559747216SDoug Rabson 	struct agp_softc *sc = device_get_softc(dev);
91659747216SDoug Rabson 
91759747216SDoug Rabson 	info->ai_mode =
91859747216SDoug Rabson 		pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4);
91959747216SDoug Rabson 	info->ai_aperture_base = rman_get_start(sc->as_aperture);
920df585170SPeter Wemm 	info->ai_aperture_size = rman_get_size(sc->as_aperture);
92159747216SDoug Rabson 	info->ai_memory_allowed = sc->as_maxmem;
92259747216SDoug Rabson 	info->ai_memory_used = sc->as_allocated;
92359747216SDoug Rabson }
92459747216SDoug Rabson 
92559747216SDoug Rabson int
92659747216SDoug Rabson agp_acquire(device_t dev)
92759747216SDoug Rabson {
92859747216SDoug Rabson 	return agp_acquire_helper(dev, AGP_ACQUIRE_KERNEL);
92959747216SDoug Rabson }
93059747216SDoug Rabson 
93159747216SDoug Rabson int
93259747216SDoug Rabson agp_release(device_t dev)
93359747216SDoug Rabson {
93459747216SDoug Rabson 	return agp_release_helper(dev, AGP_ACQUIRE_KERNEL);
93559747216SDoug Rabson }
93659747216SDoug Rabson 
93759747216SDoug Rabson int
93859747216SDoug Rabson agp_enable(device_t dev, u_int32_t mode)
93959747216SDoug Rabson {
94059747216SDoug Rabson 	return AGP_ENABLE(dev, mode);
94159747216SDoug Rabson }
94259747216SDoug Rabson 
94359747216SDoug Rabson void *agp_alloc_memory(device_t dev, int type, vm_size_t bytes)
94459747216SDoug Rabson {
94559747216SDoug Rabson 	return  (void *) AGP_ALLOC_MEMORY(dev, type, bytes);
94659747216SDoug Rabson }
94759747216SDoug Rabson 
94859747216SDoug Rabson void agp_free_memory(device_t dev, void *handle)
94959747216SDoug Rabson {
95059747216SDoug Rabson 	struct agp_memory *mem = (struct agp_memory *) handle;
95159747216SDoug Rabson 	AGP_FREE_MEMORY(dev, mem);
95259747216SDoug Rabson }
95359747216SDoug Rabson 
95459747216SDoug Rabson int agp_bind_memory(device_t dev, void *handle, vm_offset_t offset)
95559747216SDoug Rabson {
95659747216SDoug Rabson 	struct agp_memory *mem = (struct agp_memory *) handle;
95759747216SDoug Rabson 	return AGP_BIND_MEMORY(dev, mem, offset);
95859747216SDoug Rabson }
95959747216SDoug Rabson 
96059747216SDoug Rabson int agp_unbind_memory(device_t dev, void *handle)
96159747216SDoug Rabson {
96259747216SDoug Rabson 	struct agp_memory *mem = (struct agp_memory *) handle;
96359747216SDoug Rabson 	return AGP_UNBIND_MEMORY(dev, mem);
96459747216SDoug Rabson }
96559747216SDoug Rabson 
96659747216SDoug Rabson void agp_memory_info(device_t dev, void *handle, struct
96759747216SDoug Rabson 		     agp_memory_info *mi)
96859747216SDoug Rabson {
96959747216SDoug Rabson 	struct agp_memory *mem = (struct agp_memory *) handle;
97059747216SDoug Rabson 
97159747216SDoug Rabson 	mi->ami_size = mem->am_size;
97259747216SDoug Rabson 	mi->ami_physical = mem->am_physical;
97359747216SDoug Rabson 	mi->ami_offset = mem->am_offset;
97459747216SDoug Rabson 	mi->ami_is_bound = mem->am_is_bound;
97559747216SDoug Rabson }
976