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