agp.c revision 1.10.2.4
1 1.10.2.4 nathanw /* $NetBSD: agp.c,v 1.10.2.4 2001/11/14 19:15:06 nathanw Exp $ */ 2 1.10.2.2 nathanw 3 1.10.2.2 nathanw /*- 4 1.10.2.2 nathanw * Copyright (c) 2000 Doug Rabson 5 1.10.2.2 nathanw * All rights reserved. 6 1.10.2.2 nathanw * 7 1.10.2.2 nathanw * Redistribution and use in source and binary forms, with or without 8 1.10.2.2 nathanw * modification, are permitted provided that the following conditions 9 1.10.2.2 nathanw * are met: 10 1.10.2.2 nathanw * 1. Redistributions of source code must retain the above copyright 11 1.10.2.2 nathanw * notice, this list of conditions and the following disclaimer. 12 1.10.2.2 nathanw * 2. Redistributions in binary form must reproduce the above copyright 13 1.10.2.2 nathanw * notice, this list of conditions and the following disclaimer in the 14 1.10.2.2 nathanw * documentation and/or other materials provided with the distribution. 15 1.10.2.2 nathanw * 16 1.10.2.2 nathanw * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 1.10.2.2 nathanw * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 1.10.2.2 nathanw * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 1.10.2.2 nathanw * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20 1.10.2.2 nathanw * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 1.10.2.2 nathanw * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 1.10.2.2 nathanw * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 1.10.2.2 nathanw * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 1.10.2.2 nathanw * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.10.2.2 nathanw * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.10.2.2 nathanw * SUCH DAMAGE. 27 1.10.2.2 nathanw * 28 1.10.2.2 nathanw * $FreeBSD: src/sys/pci/agp.c,v 1.12 2001/05/19 01:28:07 alfred Exp $ 29 1.10.2.2 nathanw */ 30 1.10.2.2 nathanw 31 1.10.2.2 nathanw /* 32 1.10.2.2 nathanw * Copyright (c) 2001 Wasabi Systems, Inc. 33 1.10.2.2 nathanw * All rights reserved. 34 1.10.2.2 nathanw * 35 1.10.2.2 nathanw * Written by Frank van der Linden for Wasabi Systems, Inc. 36 1.10.2.2 nathanw * 37 1.10.2.2 nathanw * Redistribution and use in source and binary forms, with or without 38 1.10.2.2 nathanw * modification, are permitted provided that the following conditions 39 1.10.2.2 nathanw * are met: 40 1.10.2.2 nathanw * 1. Redistributions of source code must retain the above copyright 41 1.10.2.2 nathanw * notice, this list of conditions and the following disclaimer. 42 1.10.2.2 nathanw * 2. Redistributions in binary form must reproduce the above copyright 43 1.10.2.2 nathanw * notice, this list of conditions and the following disclaimer in the 44 1.10.2.2 nathanw * documentation and/or other materials provided with the distribution. 45 1.10.2.2 nathanw * 3. All advertising materials mentioning features or use of this software 46 1.10.2.2 nathanw * must display the following acknowledgement: 47 1.10.2.2 nathanw * This product includes software developed for the NetBSD Project by 48 1.10.2.2 nathanw * Wasabi Systems, Inc. 49 1.10.2.2 nathanw * 4. The name of Wasabi Systems, Inc. may not be used to endorse 50 1.10.2.2 nathanw * or promote products derived from this software without specific prior 51 1.10.2.2 nathanw * written permission. 52 1.10.2.2 nathanw * 53 1.10.2.2 nathanw * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 54 1.10.2.2 nathanw * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 55 1.10.2.2 nathanw * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 56 1.10.2.2 nathanw * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 57 1.10.2.2 nathanw * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 58 1.10.2.2 nathanw * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 59 1.10.2.2 nathanw * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 60 1.10.2.2 nathanw * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 61 1.10.2.2 nathanw * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 62 1.10.2.2 nathanw * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 63 1.10.2.2 nathanw * POSSIBILITY OF SUCH DAMAGE. 64 1.10.2.2 nathanw */ 65 1.10.2.2 nathanw 66 1.10.2.2 nathanw 67 1.10.2.4 nathanw #include <sys/cdefs.h> 68 1.10.2.4 nathanw __KERNEL_RCSID(0, "$NetBSD: agp.c,v 1.10.2.4 2001/11/14 19:15:06 nathanw Exp $"); 69 1.10.2.4 nathanw 70 1.10.2.2 nathanw #include <sys/param.h> 71 1.10.2.2 nathanw #include <sys/systm.h> 72 1.10.2.2 nathanw #include <sys/malloc.h> 73 1.10.2.2 nathanw #include <sys/kernel.h> 74 1.10.2.2 nathanw #include <sys/device.h> 75 1.10.2.2 nathanw #include <sys/conf.h> 76 1.10.2.2 nathanw #include <sys/ioctl.h> 77 1.10.2.2 nathanw #include <sys/fcntl.h> 78 1.10.2.2 nathanw #include <sys/agpio.h> 79 1.10.2.2 nathanw #include <sys/proc.h> 80 1.10.2.2 nathanw 81 1.10.2.2 nathanw #include <uvm/uvm_extern.h> 82 1.10.2.2 nathanw 83 1.10.2.2 nathanw #include <dev/pci/pcireg.h> 84 1.10.2.2 nathanw #include <dev/pci/pcivar.h> 85 1.10.2.2 nathanw #include <dev/pci/agpvar.h> 86 1.10.2.2 nathanw #include <dev/pci/agpreg.h> 87 1.10.2.2 nathanw #include <dev/pci/pcidevs.h> 88 1.10.2.2 nathanw 89 1.10.2.2 nathanw #include <machine/bus.h> 90 1.10.2.2 nathanw 91 1.10.2.2 nathanw /* Helper functions for implementing chipset mini drivers. */ 92 1.10.2.2 nathanw /* XXXfvdl get rid of this one. */ 93 1.10.2.2 nathanw 94 1.10.2.2 nathanw extern struct cfdriver agp_cd; 95 1.10.2.2 nathanw cdev_decl(agp); 96 1.10.2.2 nathanw 97 1.10.2.2 nathanw int agpmatch(struct device *, struct cfdata *, void *); 98 1.10.2.2 nathanw void agpattach(struct device *, struct device *, void *); 99 1.10.2.2 nathanw 100 1.10.2.2 nathanw struct cfattach agp_ca = { 101 1.10.2.2 nathanw sizeof(struct agp_softc), agpmatch, agpattach 102 1.10.2.2 nathanw }; 103 1.10.2.2 nathanw 104 1.10.2.2 nathanw static int agp_info_user(struct agp_softc *, agp_info *); 105 1.10.2.2 nathanw static int agp_setup_user(struct agp_softc *, agp_setup *); 106 1.10.2.2 nathanw static int agp_allocate_user(struct agp_softc *, agp_allocate *); 107 1.10.2.2 nathanw static int agp_deallocate_user(struct agp_softc *, int); 108 1.10.2.2 nathanw static int agp_bind_user(struct agp_softc *, agp_bind *); 109 1.10.2.2 nathanw static int agp_unbind_user(struct agp_softc *, agp_unbind *); 110 1.10.2.2 nathanw static int agpdev_match(struct pci_attach_args *); 111 1.10.2.2 nathanw 112 1.10.2.2 nathanw #include "agp_ali.h" 113 1.10.2.2 nathanw #include "agp_amd.h" 114 1.10.2.2 nathanw #include "agp_i810.h" 115 1.10.2.2 nathanw #include "agp_intel.h" 116 1.10.2.2 nathanw #include "agp_sis.h" 117 1.10.2.2 nathanw #include "agp_via.h" 118 1.10.2.2 nathanw 119 1.10.2.2 nathanw const struct agp_product { 120 1.10.2.2 nathanw uint32_t ap_vendor; 121 1.10.2.2 nathanw uint32_t ap_product; 122 1.10.2.2 nathanw int (*ap_match)(const struct pci_attach_args *); 123 1.10.2.2 nathanw int (*ap_attach)(struct device *, struct device *, void *); 124 1.10.2.2 nathanw } agp_products[] = { 125 1.10.2.2 nathanw #if NAGP_ALI > 0 126 1.10.2.2 nathanw { PCI_VENDOR_ALI, -1, 127 1.10.2.2 nathanw NULL, agp_ali_attach }, 128 1.10.2.2 nathanw #endif 129 1.10.2.2 nathanw 130 1.10.2.2 nathanw #if NAGP_AMD > 0 131 1.10.2.2 nathanw { PCI_VENDOR_AMD, -1, 132 1.10.2.2 nathanw agp_amd_match, agp_amd_attach }, 133 1.10.2.2 nathanw #endif 134 1.10.2.2 nathanw 135 1.10.2.2 nathanw #if NAGP_I810 > 0 136 1.10.2.2 nathanw { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82810_MCH, 137 1.10.2.2 nathanw NULL, agp_i810_attach }, 138 1.10.2.2 nathanw { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82810_DC100_MCH, 139 1.10.2.2 nathanw NULL, agp_i810_attach }, 140 1.10.2.2 nathanw { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82810E_MCH, 141 1.10.2.2 nathanw NULL, agp_i810_attach }, 142 1.10.2.2 nathanw { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82815_FULL_HUB, 143 1.10.2.2 nathanw NULL, agp_i810_attach }, 144 1.10.2.3 nathanw { PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82840_HB, 145 1.10.2.3 nathanw NULL, agp_i810_attach }, 146 1.10.2.2 nathanw #endif 147 1.10.2.2 nathanw 148 1.10.2.2 nathanw #if NAGP_INTEL > 0 149 1.10.2.2 nathanw { PCI_VENDOR_INTEL, -1, 150 1.10.2.2 nathanw NULL, agp_intel_attach }, 151 1.10.2.2 nathanw #endif 152 1.10.2.2 nathanw 153 1.10.2.2 nathanw #if NAGP_SIS > 0 154 1.10.2.2 nathanw { PCI_VENDOR_SIS, -1, 155 1.10.2.2 nathanw NULL, agp_sis_attach }, 156 1.10.2.2 nathanw #endif 157 1.10.2.2 nathanw 158 1.10.2.2 nathanw #if NAGP_VIA > 0 159 1.10.2.2 nathanw { PCI_VENDOR_VIATECH, -1, 160 1.10.2.2 nathanw NULL, agp_via_attach }, 161 1.10.2.2 nathanw #endif 162 1.10.2.2 nathanw 163 1.10.2.2 nathanw { 0, 0, 164 1.10.2.2 nathanw NULL, NULL }, 165 1.10.2.2 nathanw }; 166 1.10.2.2 nathanw 167 1.10.2.2 nathanw static const struct agp_product * 168 1.10.2.2 nathanw agp_lookup(const struct pci_attach_args *pa) 169 1.10.2.2 nathanw { 170 1.10.2.2 nathanw const struct agp_product *ap; 171 1.10.2.2 nathanw 172 1.10.2.2 nathanw /* First find the vendor. */ 173 1.10.2.2 nathanw for (ap = agp_products; ap->ap_attach != NULL; ap++) { 174 1.10.2.2 nathanw if (PCI_VENDOR(pa->pa_id) == ap->ap_vendor) 175 1.10.2.2 nathanw break; 176 1.10.2.2 nathanw } 177 1.10.2.2 nathanw 178 1.10.2.2 nathanw if (ap->ap_attach == NULL) 179 1.10.2.2 nathanw return (NULL); 180 1.10.2.2 nathanw 181 1.10.2.2 nathanw /* Now find the product within the vendor's domain. */ 182 1.10.2.2 nathanw for (; ap->ap_attach != NULL; ap++) { 183 1.10.2.2 nathanw if (PCI_VENDOR(pa->pa_id) != ap->ap_vendor) { 184 1.10.2.2 nathanw /* Ran out of this vendor's section of the table. */ 185 1.10.2.2 nathanw return (NULL); 186 1.10.2.2 nathanw } 187 1.10.2.2 nathanw if (ap->ap_product == PCI_PRODUCT(pa->pa_id)) { 188 1.10.2.2 nathanw /* Exact match. */ 189 1.10.2.2 nathanw break; 190 1.10.2.2 nathanw } 191 1.10.2.2 nathanw if (ap->ap_product == (uint32_t) -1) { 192 1.10.2.2 nathanw /* Wildcard match. */ 193 1.10.2.2 nathanw break; 194 1.10.2.2 nathanw } 195 1.10.2.2 nathanw } 196 1.10.2.2 nathanw 197 1.10.2.2 nathanw if (ap->ap_attach == NULL) 198 1.10.2.2 nathanw return (NULL); 199 1.10.2.2 nathanw 200 1.10.2.2 nathanw /* Now let the product-specific driver filter the match. */ 201 1.10.2.2 nathanw if (ap->ap_match != NULL && (*ap->ap_match)(pa) == 0) 202 1.10.2.2 nathanw return (NULL); 203 1.10.2.2 nathanw 204 1.10.2.2 nathanw return (ap); 205 1.10.2.2 nathanw } 206 1.10.2.2 nathanw 207 1.10.2.2 nathanw int 208 1.10.2.2 nathanw agpmatch(struct device *parent, struct cfdata *match, void *aux) 209 1.10.2.2 nathanw { 210 1.10.2.2 nathanw struct agpbus_attach_args *apa = aux; 211 1.10.2.2 nathanw struct pci_attach_args *pa = &apa->apa_pci_args; 212 1.10.2.2 nathanw 213 1.10.2.2 nathanw if (strcmp(apa->apa_busname, "agp") != 0) 214 1.10.2.2 nathanw return (0); 215 1.10.2.2 nathanw 216 1.10.2.2 nathanw if (agp_lookup(pa) == NULL) 217 1.10.2.2 nathanw return (0); 218 1.10.2.2 nathanw 219 1.10.2.2 nathanw return (1); 220 1.10.2.2 nathanw } 221 1.10.2.2 nathanw 222 1.10.2.2 nathanw static int agp_max[][2] = { 223 1.10.2.2 nathanw {0, 0}, 224 1.10.2.2 nathanw {32, 4}, 225 1.10.2.2 nathanw {64, 28}, 226 1.10.2.2 nathanw {128, 96}, 227 1.10.2.2 nathanw {256, 204}, 228 1.10.2.2 nathanw {512, 440}, 229 1.10.2.2 nathanw {1024, 942}, 230 1.10.2.2 nathanw {2048, 1920}, 231 1.10.2.2 nathanw {4096, 3932} 232 1.10.2.2 nathanw }; 233 1.10.2.2 nathanw #define agp_max_size (sizeof(agp_max) / sizeof(agp_max[0])) 234 1.10.2.2 nathanw 235 1.10.2.2 nathanw void 236 1.10.2.2 nathanw agpattach(struct device *parent, struct device *self, void *aux) 237 1.10.2.2 nathanw { 238 1.10.2.2 nathanw struct agpbus_attach_args *apa = aux; 239 1.10.2.2 nathanw struct pci_attach_args *pa = &apa->apa_pci_args; 240 1.10.2.2 nathanw struct agp_softc *sc = (void *)self; 241 1.10.2.2 nathanw const struct agp_product *ap; 242 1.10.2.2 nathanw int memsize, i, ret; 243 1.10.2.2 nathanw 244 1.10.2.2 nathanw ap = agp_lookup(pa); 245 1.10.2.2 nathanw if (ap == NULL) { 246 1.10.2.2 nathanw printf("\n"); 247 1.10.2.2 nathanw panic("agpattach: impossible"); 248 1.10.2.2 nathanw } 249 1.10.2.2 nathanw 250 1.10.2.2 nathanw sc->as_dmat = pa->pa_dmat; 251 1.10.2.2 nathanw sc->as_pc = pa->pa_pc; 252 1.10.2.2 nathanw sc->as_tag = pa->pa_tag; 253 1.10.2.2 nathanw sc->as_id = pa->pa_id; 254 1.10.2.2 nathanw 255 1.10.2.2 nathanw /* 256 1.10.2.2 nathanw * Work out an upper bound for agp memory allocation. This 257 1.10.2.2 nathanw * uses a heurisitc table from the Linux driver. 258 1.10.2.2 nathanw */ 259 1.10.2.2 nathanw memsize = ptoa(physmem) >> 20; 260 1.10.2.2 nathanw for (i = 0; i < agp_max_size; i++) { 261 1.10.2.2 nathanw if (memsize <= agp_max[i][0]) 262 1.10.2.2 nathanw break; 263 1.10.2.2 nathanw } 264 1.10.2.2 nathanw if (i == agp_max_size) 265 1.10.2.2 nathanw i = agp_max_size - 1; 266 1.10.2.2 nathanw sc->as_maxmem = agp_max[i][1] << 20U; 267 1.10.2.2 nathanw 268 1.10.2.2 nathanw /* 269 1.10.2.2 nathanw * The lock is used to prevent re-entry to 270 1.10.2.2 nathanw * agp_generic_bind_memory() since that function can sleep. 271 1.10.2.2 nathanw */ 272 1.10.2.2 nathanw lockinit(&sc->as_lock, PZERO|PCATCH, "agplk", 0, 0); 273 1.10.2.2 nathanw 274 1.10.2.2 nathanw TAILQ_INIT(&sc->as_memory); 275 1.10.2.2 nathanw 276 1.10.2.2 nathanw ret = (*ap->ap_attach)(parent, self, pa); 277 1.10.2.2 nathanw if (ret == 0) 278 1.10.2.2 nathanw printf(": aperture at 0x%lx, size 0x%lx\n", 279 1.10.2.2 nathanw (unsigned long)sc->as_apaddr, 280 1.10.2.2 nathanw (unsigned long)AGP_GET_APERTURE(sc)); 281 1.10.2.2 nathanw else 282 1.10.2.2 nathanw sc->as_chipc = NULL; 283 1.10.2.2 nathanw } 284 1.10.2.2 nathanw int 285 1.10.2.2 nathanw agp_map_aperture(struct pci_attach_args *pa, struct agp_softc *sc) 286 1.10.2.2 nathanw { 287 1.10.2.2 nathanw /* 288 1.10.2.3 nathanw * Find and the aperture. Don't map it (yet), this would 289 1.10.2.3 nathanw * eat KVA. 290 1.10.2.2 nathanw */ 291 1.10.2.3 nathanw if (pci_mapreg_info(pa->pa_pc, pa->pa_tag, AGP_APBASE, 292 1.10.2.3 nathanw PCI_MAPREG_TYPE_MEM, &sc->as_apaddr, &sc->as_apsize, 293 1.10.2.3 nathanw &sc->as_apflags) != 0) 294 1.10.2.2 nathanw return ENXIO; 295 1.10.2.2 nathanw 296 1.10.2.3 nathanw sc->as_apt = pa->pa_memt; 297 1.10.2.3 nathanw 298 1.10.2.2 nathanw return 0; 299 1.10.2.2 nathanw } 300 1.10.2.2 nathanw 301 1.10.2.2 nathanw struct agp_gatt * 302 1.10.2.2 nathanw agp_alloc_gatt(struct agp_softc *sc) 303 1.10.2.2 nathanw { 304 1.10.2.2 nathanw u_int32_t apsize = AGP_GET_APERTURE(sc); 305 1.10.2.2 nathanw u_int32_t entries = apsize >> AGP_PAGE_SHIFT; 306 1.10.2.2 nathanw struct agp_gatt *gatt; 307 1.10.2.2 nathanw int dummyseg; 308 1.10.2.2 nathanw 309 1.10.2.2 nathanw gatt = malloc(sizeof(struct agp_gatt), M_AGP, M_NOWAIT); 310 1.10.2.2 nathanw if (!gatt) 311 1.10.2.2 nathanw return NULL; 312 1.10.2.2 nathanw gatt->ag_entries = entries; 313 1.10.2.2 nathanw 314 1.10.2.2 nathanw if (agp_alloc_dmamem(sc->as_dmat, entries * sizeof(u_int32_t), 315 1.10.2.2 nathanw 0, &gatt->ag_dmamap, (caddr_t *)&gatt->ag_virtual, 316 1.10.2.2 nathanw &gatt->ag_physical, &gatt->ag_dmaseg, 1, &dummyseg) != 0) 317 1.10.2.2 nathanw return NULL; 318 1.10.2.2 nathanw 319 1.10.2.2 nathanw gatt->ag_size = entries * sizeof(u_int32_t); 320 1.10.2.2 nathanw memset(gatt->ag_virtual, 0, gatt->ag_size); 321 1.10.2.2 nathanw agp_flush_cache(); 322 1.10.2.2 nathanw 323 1.10.2.2 nathanw return gatt; 324 1.10.2.2 nathanw } 325 1.10.2.2 nathanw 326 1.10.2.2 nathanw void 327 1.10.2.2 nathanw agp_free_gatt(struct agp_softc *sc, struct agp_gatt *gatt) 328 1.10.2.2 nathanw { 329 1.10.2.2 nathanw agp_free_dmamem(sc->as_dmat, gatt->ag_size, gatt->ag_dmamap, 330 1.10.2.2 nathanw (caddr_t)gatt->ag_virtual, &gatt->ag_dmaseg, 1); 331 1.10.2.2 nathanw free(gatt, M_AGP); 332 1.10.2.2 nathanw } 333 1.10.2.2 nathanw 334 1.10.2.2 nathanw 335 1.10.2.2 nathanw int 336 1.10.2.2 nathanw agp_generic_detach(struct agp_softc *sc) 337 1.10.2.2 nathanw { 338 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_DRAIN, 0); 339 1.10.2.2 nathanw agp_flush_cache(); 340 1.10.2.2 nathanw return 0; 341 1.10.2.2 nathanw } 342 1.10.2.2 nathanw 343 1.10.2.2 nathanw static int 344 1.10.2.2 nathanw agpdev_match(struct pci_attach_args *pa) 345 1.10.2.2 nathanw { 346 1.10.2.2 nathanw if (PCI_CLASS(pa->pa_class) == PCI_CLASS_DISPLAY && 347 1.10.2.2 nathanw PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_DISPLAY_VGA) 348 1.10.2.2 nathanw return 1; 349 1.10.2.2 nathanw 350 1.10.2.2 nathanw return 0; 351 1.10.2.2 nathanw } 352 1.10.2.2 nathanw 353 1.10.2.2 nathanw int 354 1.10.2.2 nathanw agp_generic_enable(struct agp_softc *sc, u_int32_t mode) 355 1.10.2.2 nathanw { 356 1.10.2.2 nathanw struct pci_attach_args pa; 357 1.10.2.2 nathanw pcireg_t tstatus, mstatus; 358 1.10.2.2 nathanw pcireg_t command; 359 1.10.2.2 nathanw int rq, sba, fw, rate, capoff; 360 1.10.2.2 nathanw 361 1.10.2.2 nathanw if (pci_find_device(&pa, agpdev_match) == 0 || 362 1.10.2.2 nathanw pci_get_capability(pa.pa_pc, pa.pa_tag, PCI_CAP_AGP, 363 1.10.2.2 nathanw &capoff, NULL) == 0) { 364 1.10.2.2 nathanw printf("%s: can't find display\n", sc->as_dev.dv_xname); 365 1.10.2.2 nathanw return ENXIO; 366 1.10.2.2 nathanw } 367 1.10.2.2 nathanw 368 1.10.2.2 nathanw tstatus = pci_conf_read(sc->as_pc, sc->as_tag, 369 1.10.2.2 nathanw sc->as_capoff + AGP_STATUS); 370 1.10.2.2 nathanw mstatus = pci_conf_read(pa.pa_pc, pa.pa_tag, 371 1.10.2.2 nathanw capoff + AGP_STATUS); 372 1.10.2.2 nathanw 373 1.10.2.2 nathanw /* Set RQ to the min of mode, tstatus and mstatus */ 374 1.10.2.2 nathanw rq = AGP_MODE_GET_RQ(mode); 375 1.10.2.2 nathanw if (AGP_MODE_GET_RQ(tstatus) < rq) 376 1.10.2.2 nathanw rq = AGP_MODE_GET_RQ(tstatus); 377 1.10.2.2 nathanw if (AGP_MODE_GET_RQ(mstatus) < rq) 378 1.10.2.2 nathanw rq = AGP_MODE_GET_RQ(mstatus); 379 1.10.2.2 nathanw 380 1.10.2.2 nathanw /* Set SBA if all three can deal with SBA */ 381 1.10.2.2 nathanw sba = (AGP_MODE_GET_SBA(tstatus) 382 1.10.2.2 nathanw & AGP_MODE_GET_SBA(mstatus) 383 1.10.2.2 nathanw & AGP_MODE_GET_SBA(mode)); 384 1.10.2.2 nathanw 385 1.10.2.2 nathanw /* Similar for FW */ 386 1.10.2.2 nathanw fw = (AGP_MODE_GET_FW(tstatus) 387 1.10.2.2 nathanw & AGP_MODE_GET_FW(mstatus) 388 1.10.2.2 nathanw & AGP_MODE_GET_FW(mode)); 389 1.10.2.2 nathanw 390 1.10.2.2 nathanw /* Figure out the max rate */ 391 1.10.2.2 nathanw rate = (AGP_MODE_GET_RATE(tstatus) 392 1.10.2.2 nathanw & AGP_MODE_GET_RATE(mstatus) 393 1.10.2.2 nathanw & AGP_MODE_GET_RATE(mode)); 394 1.10.2.2 nathanw if (rate & AGP_MODE_RATE_4x) 395 1.10.2.2 nathanw rate = AGP_MODE_RATE_4x; 396 1.10.2.2 nathanw else if (rate & AGP_MODE_RATE_2x) 397 1.10.2.2 nathanw rate = AGP_MODE_RATE_2x; 398 1.10.2.2 nathanw else 399 1.10.2.2 nathanw rate = AGP_MODE_RATE_1x; 400 1.10.2.2 nathanw 401 1.10.2.2 nathanw /* Construct the new mode word and tell the hardware */ 402 1.10.2.2 nathanw command = AGP_MODE_SET_RQ(0, rq); 403 1.10.2.2 nathanw command = AGP_MODE_SET_SBA(command, sba); 404 1.10.2.2 nathanw command = AGP_MODE_SET_FW(command, fw); 405 1.10.2.2 nathanw command = AGP_MODE_SET_RATE(command, rate); 406 1.10.2.2 nathanw command = AGP_MODE_SET_AGP(command, 1); 407 1.10.2.2 nathanw pci_conf_write(sc->as_pc, sc->as_tag, 408 1.10.2.2 nathanw sc->as_capoff + AGP_COMMAND, command); 409 1.10.2.2 nathanw pci_conf_write(pa.pa_pc, pa.pa_tag, capoff + AGP_COMMAND, command); 410 1.10.2.2 nathanw 411 1.10.2.2 nathanw return 0; 412 1.10.2.2 nathanw } 413 1.10.2.2 nathanw 414 1.10.2.2 nathanw struct agp_memory * 415 1.10.2.2 nathanw agp_generic_alloc_memory(struct agp_softc *sc, int type, vsize_t size) 416 1.10.2.2 nathanw { 417 1.10.2.2 nathanw struct agp_memory *mem; 418 1.10.2.2 nathanw 419 1.10.2.2 nathanw if ((size & (AGP_PAGE_SIZE - 1)) != 0) 420 1.10.2.2 nathanw return 0; 421 1.10.2.2 nathanw 422 1.10.2.2 nathanw if (sc->as_allocated + size > sc->as_maxmem) 423 1.10.2.2 nathanw return 0; 424 1.10.2.2 nathanw 425 1.10.2.2 nathanw if (type != 0) { 426 1.10.2.2 nathanw printf("agp_generic_alloc_memory: unsupported type %d\n", 427 1.10.2.2 nathanw type); 428 1.10.2.2 nathanw return 0; 429 1.10.2.2 nathanw } 430 1.10.2.2 nathanw 431 1.10.2.2 nathanw mem = malloc(sizeof *mem, M_AGP, M_WAITOK); 432 1.10.2.2 nathanw if (mem == NULL) 433 1.10.2.2 nathanw return NULL; 434 1.10.2.2 nathanw 435 1.10.2.2 nathanw if (bus_dmamap_create(sc->as_dmat, size, size / PAGE_SIZE + 1, 436 1.10.2.2 nathanw size, 0, BUS_DMA_NOWAIT, &mem->am_dmamap) != 0) { 437 1.10.2.2 nathanw free(mem, M_AGP); 438 1.10.2.2 nathanw return NULL; 439 1.10.2.2 nathanw } 440 1.10.2.2 nathanw 441 1.10.2.2 nathanw mem->am_id = sc->as_nextid++; 442 1.10.2.2 nathanw mem->am_size = size; 443 1.10.2.2 nathanw mem->am_type = 0; 444 1.10.2.2 nathanw mem->am_physical = 0; 445 1.10.2.2 nathanw mem->am_offset = 0; 446 1.10.2.2 nathanw mem->am_is_bound = 0; 447 1.10.2.2 nathanw TAILQ_INSERT_TAIL(&sc->as_memory, mem, am_link); 448 1.10.2.2 nathanw sc->as_allocated += size; 449 1.10.2.2 nathanw 450 1.10.2.2 nathanw return mem; 451 1.10.2.2 nathanw } 452 1.10.2.2 nathanw 453 1.10.2.2 nathanw int 454 1.10.2.2 nathanw agp_generic_free_memory(struct agp_softc *sc, struct agp_memory *mem) 455 1.10.2.2 nathanw { 456 1.10.2.2 nathanw if (mem->am_is_bound) 457 1.10.2.2 nathanw return EBUSY; 458 1.10.2.2 nathanw 459 1.10.2.2 nathanw sc->as_allocated -= mem->am_size; 460 1.10.2.2 nathanw TAILQ_REMOVE(&sc->as_memory, mem, am_link); 461 1.10.2.2 nathanw bus_dmamap_destroy(sc->as_dmat, mem->am_dmamap); 462 1.10.2.2 nathanw free(mem, M_AGP); 463 1.10.2.2 nathanw return 0; 464 1.10.2.2 nathanw } 465 1.10.2.2 nathanw 466 1.10.2.2 nathanw int 467 1.10.2.2 nathanw agp_generic_bind_memory(struct agp_softc *sc, struct agp_memory *mem, 468 1.10.2.2 nathanw off_t offset) 469 1.10.2.2 nathanw { 470 1.10.2.2 nathanw off_t i, k; 471 1.10.2.2 nathanw bus_size_t done, j; 472 1.10.2.2 nathanw int error; 473 1.10.2.2 nathanw bus_dma_segment_t *segs, *seg; 474 1.10.2.2 nathanw bus_addr_t pa; 475 1.10.2.2 nathanw int contigpages, nseg; 476 1.10.2.2 nathanw 477 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_EXCLUSIVE, 0); 478 1.10.2.2 nathanw 479 1.10.2.2 nathanw if (mem->am_is_bound) { 480 1.10.2.2 nathanw printf("%s: memory already bound\n", sc->as_dev.dv_xname); 481 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 482 1.10.2.2 nathanw return EINVAL; 483 1.10.2.2 nathanw } 484 1.10.2.2 nathanw 485 1.10.2.2 nathanw if (offset < 0 486 1.10.2.2 nathanw || (offset & (AGP_PAGE_SIZE - 1)) != 0 487 1.10.2.2 nathanw || offset + mem->am_size > AGP_GET_APERTURE(sc)) { 488 1.10.2.2 nathanw printf("%s: binding memory at bad offset %#lx\n", 489 1.10.2.2 nathanw sc->as_dev.dv_xname, (unsigned long) offset); 490 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 491 1.10.2.2 nathanw return EINVAL; 492 1.10.2.2 nathanw } 493 1.10.2.2 nathanw 494 1.10.2.2 nathanw /* 495 1.10.2.2 nathanw * XXXfvdl 496 1.10.2.2 nathanw * The memory here needs to be directly accessable from the 497 1.10.2.2 nathanw * AGP video card, so it should be allocated using bus_dma. 498 1.10.2.2 nathanw * However, it need not be contiguous, since individual pages 499 1.10.2.2 nathanw * are translated using the GATT. 500 1.10.2.2 nathanw * 501 1.10.2.2 nathanw * Using a large chunk of contiguous memory may get in the way 502 1.10.2.2 nathanw * of other subsystems that may need one, so we try to be friendly 503 1.10.2.2 nathanw * and ask for allocation in chunks of a minimum of 8 pages 504 1.10.2.2 nathanw * of contiguous memory on average, falling back to 4, 2 and 1 505 1.10.2.2 nathanw * if really needed. Larger chunks are preferred, since allocating 506 1.10.2.2 nathanw * a bus_dma_segment per page would be overkill. 507 1.10.2.2 nathanw */ 508 1.10.2.2 nathanw 509 1.10.2.2 nathanw for (contigpages = 8; contigpages > 0; contigpages >>= 1) { 510 1.10.2.2 nathanw nseg = (mem->am_size / (contigpages * PAGE_SIZE)) + 1; 511 1.10.2.2 nathanw segs = malloc(nseg * sizeof *segs, M_AGP, M_WAITOK); 512 1.10.2.2 nathanw if (segs == NULL) 513 1.10.2.2 nathanw return ENOMEM; 514 1.10.2.2 nathanw if (bus_dmamem_alloc(sc->as_dmat, mem->am_size, PAGE_SIZE, 0, 515 1.10.2.2 nathanw segs, nseg, &mem->am_nseg, 516 1.10.2.2 nathanw BUS_DMA_WAITOK) != 0) { 517 1.10.2.2 nathanw free(segs, M_AGP); 518 1.10.2.2 nathanw continue; 519 1.10.2.2 nathanw } 520 1.10.2.2 nathanw if (bus_dmamem_map(sc->as_dmat, segs, mem->am_nseg, 521 1.10.2.2 nathanw mem->am_size, &mem->am_virtual, BUS_DMA_WAITOK) != 0) { 522 1.10.2.2 nathanw bus_dmamem_free(sc->as_dmat, segs, mem->am_nseg); 523 1.10.2.2 nathanw free(segs, M_AGP); 524 1.10.2.2 nathanw continue; 525 1.10.2.2 nathanw } 526 1.10.2.2 nathanw if (bus_dmamap_load(sc->as_dmat, mem->am_dmamap, 527 1.10.2.2 nathanw mem->am_virtual, mem->am_size, NULL, BUS_DMA_WAITOK) != 0) { 528 1.10.2.2 nathanw bus_dmamem_unmap(sc->as_dmat, mem->am_virtual, 529 1.10.2.2 nathanw mem->am_size); 530 1.10.2.2 nathanw bus_dmamem_free(sc->as_dmat, segs, mem->am_nseg); 531 1.10.2.2 nathanw free(segs, M_AGP); 532 1.10.2.2 nathanw continue; 533 1.10.2.2 nathanw } 534 1.10.2.2 nathanw mem->am_dmaseg = segs; 535 1.10.2.2 nathanw break; 536 1.10.2.2 nathanw } 537 1.10.2.2 nathanw 538 1.10.2.2 nathanw if (contigpages == 0) { 539 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 540 1.10.2.2 nathanw return ENOMEM; 541 1.10.2.2 nathanw } 542 1.10.2.2 nathanw 543 1.10.2.2 nathanw 544 1.10.2.2 nathanw /* 545 1.10.2.2 nathanw * Bind the individual pages and flush the chipset's 546 1.10.2.2 nathanw * TLB. 547 1.10.2.2 nathanw */ 548 1.10.2.2 nathanw done = 0; 549 1.10.2.2 nathanw for (i = 0; i < mem->am_dmamap->dm_nsegs; i++) { 550 1.10.2.2 nathanw seg = &mem->am_dmamap->dm_segs[i]; 551 1.10.2.2 nathanw /* 552 1.10.2.2 nathanw * Install entries in the GATT, making sure that if 553 1.10.2.2 nathanw * AGP_PAGE_SIZE < PAGE_SIZE and mem->am_size is not 554 1.10.2.2 nathanw * aligned to PAGE_SIZE, we don't modify too many GATT 555 1.10.2.2 nathanw * entries. 556 1.10.2.2 nathanw */ 557 1.10.2.2 nathanw for (j = 0; j < seg->ds_len && (done + j) < mem->am_size; 558 1.10.2.2 nathanw j += AGP_PAGE_SIZE) { 559 1.10.2.2 nathanw pa = seg->ds_addr + j; 560 1.10.2.2 nathanw AGP_DPF("binding offset %#lx to pa %#lx\n", 561 1.10.2.2 nathanw (unsigned long)(offset + done + j), 562 1.10.2.2 nathanw (unsigned long)pa); 563 1.10.2.2 nathanw error = AGP_BIND_PAGE(sc, offset + done + j, pa); 564 1.10.2.2 nathanw if (error) { 565 1.10.2.2 nathanw /* 566 1.10.2.2 nathanw * Bail out. Reverse all the mappings 567 1.10.2.2 nathanw * and unwire the pages. 568 1.10.2.2 nathanw */ 569 1.10.2.2 nathanw for (k = 0; k < done + j; k += AGP_PAGE_SIZE) 570 1.10.2.2 nathanw AGP_UNBIND_PAGE(sc, offset + k); 571 1.10.2.2 nathanw 572 1.10.2.2 nathanw bus_dmamap_unload(sc->as_dmat, mem->am_dmamap); 573 1.10.2.2 nathanw bus_dmamem_unmap(sc->as_dmat, mem->am_virtual, 574 1.10.2.2 nathanw mem->am_size); 575 1.10.2.2 nathanw bus_dmamem_free(sc->as_dmat, mem->am_dmaseg, 576 1.10.2.2 nathanw mem->am_nseg); 577 1.10.2.2 nathanw free(mem->am_dmaseg, M_AGP); 578 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 579 1.10.2.2 nathanw return error; 580 1.10.2.2 nathanw } 581 1.10.2.2 nathanw } 582 1.10.2.2 nathanw done += seg->ds_len; 583 1.10.2.2 nathanw } 584 1.10.2.2 nathanw 585 1.10.2.2 nathanw /* 586 1.10.2.2 nathanw * Flush the cpu cache since we are providing a new mapping 587 1.10.2.2 nathanw * for these pages. 588 1.10.2.2 nathanw */ 589 1.10.2.2 nathanw agp_flush_cache(); 590 1.10.2.2 nathanw 591 1.10.2.2 nathanw /* 592 1.10.2.2 nathanw * Make sure the chipset gets the new mappings. 593 1.10.2.2 nathanw */ 594 1.10.2.2 nathanw AGP_FLUSH_TLB(sc); 595 1.10.2.2 nathanw 596 1.10.2.2 nathanw mem->am_offset = offset; 597 1.10.2.2 nathanw mem->am_is_bound = 1; 598 1.10.2.2 nathanw 599 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 600 1.10.2.2 nathanw 601 1.10.2.2 nathanw return 0; 602 1.10.2.2 nathanw } 603 1.10.2.2 nathanw 604 1.10.2.2 nathanw int 605 1.10.2.2 nathanw agp_generic_unbind_memory(struct agp_softc *sc, struct agp_memory *mem) 606 1.10.2.2 nathanw { 607 1.10.2.2 nathanw int i; 608 1.10.2.2 nathanw 609 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_EXCLUSIVE, 0); 610 1.10.2.2 nathanw 611 1.10.2.2 nathanw if (!mem->am_is_bound) { 612 1.10.2.2 nathanw printf("%s: memory is not bound\n", sc->as_dev.dv_xname); 613 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 614 1.10.2.2 nathanw return EINVAL; 615 1.10.2.2 nathanw } 616 1.10.2.2 nathanw 617 1.10.2.2 nathanw 618 1.10.2.2 nathanw /* 619 1.10.2.2 nathanw * Unbind the individual pages and flush the chipset's 620 1.10.2.2 nathanw * TLB. Unwire the pages so they can be swapped. 621 1.10.2.2 nathanw */ 622 1.10.2.2 nathanw for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE) 623 1.10.2.2 nathanw AGP_UNBIND_PAGE(sc, mem->am_offset + i); 624 1.10.2.2 nathanw 625 1.10.2.2 nathanw agp_flush_cache(); 626 1.10.2.2 nathanw AGP_FLUSH_TLB(sc); 627 1.10.2.2 nathanw 628 1.10.2.2 nathanw bus_dmamap_unload(sc->as_dmat, mem->am_dmamap); 629 1.10.2.2 nathanw bus_dmamem_unmap(sc->as_dmat, mem->am_virtual, mem->am_size); 630 1.10.2.2 nathanw bus_dmamem_free(sc->as_dmat, mem->am_dmaseg, mem->am_nseg); 631 1.10.2.2 nathanw 632 1.10.2.2 nathanw free(mem->am_dmaseg, M_AGP); 633 1.10.2.2 nathanw 634 1.10.2.2 nathanw mem->am_offset = 0; 635 1.10.2.2 nathanw mem->am_is_bound = 0; 636 1.10.2.2 nathanw 637 1.10.2.2 nathanw lockmgr(&sc->as_lock, LK_RELEASE, 0); 638 1.10.2.2 nathanw 639 1.10.2.2 nathanw return 0; 640 1.10.2.2 nathanw } 641 1.10.2.2 nathanw 642 1.10.2.2 nathanw /* Helper functions for implementing user/kernel api */ 643 1.10.2.2 nathanw 644 1.10.2.2 nathanw static int 645 1.10.2.2 nathanw agp_acquire_helper(struct agp_softc *sc, enum agp_acquire_state state) 646 1.10.2.2 nathanw { 647 1.10.2.2 nathanw if (sc->as_state != AGP_ACQUIRE_FREE) 648 1.10.2.2 nathanw return EBUSY; 649 1.10.2.2 nathanw sc->as_state = state; 650 1.10.2.2 nathanw 651 1.10.2.2 nathanw return 0; 652 1.10.2.2 nathanw } 653 1.10.2.2 nathanw 654 1.10.2.2 nathanw static int 655 1.10.2.2 nathanw agp_release_helper(struct agp_softc *sc, enum agp_acquire_state state) 656 1.10.2.2 nathanw { 657 1.10.2.2 nathanw struct agp_memory *mem; 658 1.10.2.2 nathanw 659 1.10.2.2 nathanw if (sc->as_state == AGP_ACQUIRE_FREE) 660 1.10.2.2 nathanw return 0; 661 1.10.2.2 nathanw 662 1.10.2.2 nathanw if (sc->as_state != state) 663 1.10.2.2 nathanw return EBUSY; 664 1.10.2.2 nathanw 665 1.10.2.2 nathanw /* 666 1.10.2.2 nathanw * Clear out the aperture and free any outstanding memory blocks. 667 1.10.2.2 nathanw */ 668 1.10.2.2 nathanw TAILQ_FOREACH(mem, &sc->as_memory, am_link) { 669 1.10.2.2 nathanw if (mem->am_is_bound) { 670 1.10.2.2 nathanw printf("agp_release_helper: mem %d is bound\n", 671 1.10.2.2 nathanw mem->am_id); 672 1.10.2.2 nathanw AGP_UNBIND_MEMORY(sc, mem); 673 1.10.2.2 nathanw } 674 1.10.2.2 nathanw } 675 1.10.2.2 nathanw 676 1.10.2.2 nathanw sc->as_state = AGP_ACQUIRE_FREE; 677 1.10.2.2 nathanw return 0; 678 1.10.2.2 nathanw } 679 1.10.2.2 nathanw 680 1.10.2.2 nathanw static struct agp_memory * 681 1.10.2.2 nathanw agp_find_memory(struct agp_softc *sc, int id) 682 1.10.2.2 nathanw { 683 1.10.2.2 nathanw struct agp_memory *mem; 684 1.10.2.2 nathanw 685 1.10.2.2 nathanw AGP_DPF("searching for memory block %d\n", id); 686 1.10.2.2 nathanw TAILQ_FOREACH(mem, &sc->as_memory, am_link) { 687 1.10.2.2 nathanw AGP_DPF("considering memory block %d\n", mem->am_id); 688 1.10.2.2 nathanw if (mem->am_id == id) 689 1.10.2.2 nathanw return mem; 690 1.10.2.2 nathanw } 691 1.10.2.2 nathanw return 0; 692 1.10.2.2 nathanw } 693 1.10.2.2 nathanw 694 1.10.2.2 nathanw /* Implementation of the userland ioctl api */ 695 1.10.2.2 nathanw 696 1.10.2.2 nathanw static int 697 1.10.2.2 nathanw agp_info_user(struct agp_softc *sc, agp_info *info) 698 1.10.2.2 nathanw { 699 1.10.2.2 nathanw memset(info, 0, sizeof *info); 700 1.10.2.2 nathanw info->bridge_id = sc->as_id; 701 1.10.2.2 nathanw if (sc->as_capoff != 0) 702 1.10.2.2 nathanw info->agp_mode = pci_conf_read(sc->as_pc, sc->as_tag, 703 1.10.2.2 nathanw sc->as_capoff + AGP_STATUS); 704 1.10.2.2 nathanw else 705 1.10.2.2 nathanw info->agp_mode = 0; /* i810 doesn't have real AGP */ 706 1.10.2.2 nathanw info->aper_base = sc->as_apaddr; 707 1.10.2.2 nathanw info->aper_size = AGP_GET_APERTURE(sc) >> 20; 708 1.10.2.2 nathanw info->pg_total = info->pg_system = sc->as_maxmem >> AGP_PAGE_SHIFT; 709 1.10.2.2 nathanw info->pg_used = sc->as_allocated >> AGP_PAGE_SHIFT; 710 1.10.2.2 nathanw 711 1.10.2.2 nathanw return 0; 712 1.10.2.2 nathanw } 713 1.10.2.2 nathanw 714 1.10.2.2 nathanw static int 715 1.10.2.2 nathanw agp_setup_user(struct agp_softc *sc, agp_setup *setup) 716 1.10.2.2 nathanw { 717 1.10.2.2 nathanw return AGP_ENABLE(sc, setup->agp_mode); 718 1.10.2.2 nathanw } 719 1.10.2.2 nathanw 720 1.10.2.2 nathanw static int 721 1.10.2.2 nathanw agp_allocate_user(struct agp_softc *sc, agp_allocate *alloc) 722 1.10.2.2 nathanw { 723 1.10.2.2 nathanw struct agp_memory *mem; 724 1.10.2.2 nathanw 725 1.10.2.2 nathanw mem = AGP_ALLOC_MEMORY(sc, 726 1.10.2.2 nathanw alloc->type, 727 1.10.2.2 nathanw alloc->pg_count << AGP_PAGE_SHIFT); 728 1.10.2.2 nathanw if (mem) { 729 1.10.2.2 nathanw alloc->key = mem->am_id; 730 1.10.2.2 nathanw alloc->physical = mem->am_physical; 731 1.10.2.2 nathanw return 0; 732 1.10.2.2 nathanw } else { 733 1.10.2.2 nathanw return ENOMEM; 734 1.10.2.2 nathanw } 735 1.10.2.2 nathanw } 736 1.10.2.2 nathanw 737 1.10.2.2 nathanw static int 738 1.10.2.2 nathanw agp_deallocate_user(struct agp_softc *sc, int id) 739 1.10.2.2 nathanw { 740 1.10.2.2 nathanw struct agp_memory *mem = agp_find_memory(sc, id); 741 1.10.2.2 nathanw 742 1.10.2.2 nathanw if (mem) { 743 1.10.2.2 nathanw AGP_FREE_MEMORY(sc, mem); 744 1.10.2.2 nathanw return 0; 745 1.10.2.2 nathanw } else { 746 1.10.2.2 nathanw return ENOENT; 747 1.10.2.2 nathanw } 748 1.10.2.2 nathanw } 749 1.10.2.2 nathanw 750 1.10.2.2 nathanw static int 751 1.10.2.2 nathanw agp_bind_user(struct agp_softc *sc, agp_bind *bind) 752 1.10.2.2 nathanw { 753 1.10.2.2 nathanw struct agp_memory *mem = agp_find_memory(sc, bind->key); 754 1.10.2.2 nathanw 755 1.10.2.2 nathanw if (!mem) 756 1.10.2.2 nathanw return ENOENT; 757 1.10.2.2 nathanw 758 1.10.2.2 nathanw return AGP_BIND_MEMORY(sc, mem, bind->pg_start << AGP_PAGE_SHIFT); 759 1.10.2.2 nathanw } 760 1.10.2.2 nathanw 761 1.10.2.2 nathanw static int 762 1.10.2.2 nathanw agp_unbind_user(struct agp_softc *sc, agp_unbind *unbind) 763 1.10.2.2 nathanw { 764 1.10.2.2 nathanw struct agp_memory *mem = agp_find_memory(sc, unbind->key); 765 1.10.2.2 nathanw 766 1.10.2.2 nathanw if (!mem) 767 1.10.2.2 nathanw return ENOENT; 768 1.10.2.2 nathanw 769 1.10.2.2 nathanw return AGP_UNBIND_MEMORY(sc, mem); 770 1.10.2.2 nathanw } 771 1.10.2.2 nathanw 772 1.10.2.2 nathanw int 773 1.10.2.2 nathanw agpopen(dev_t dev, int oflags, int devtype, struct proc *p) 774 1.10.2.2 nathanw { 775 1.10.2.2 nathanw struct agp_softc *sc = device_lookup(&agp_cd, AGPUNIT(dev)); 776 1.10.2.2 nathanw 777 1.10.2.2 nathanw if (sc == NULL) 778 1.10.2.2 nathanw return ENXIO; 779 1.10.2.2 nathanw 780 1.10.2.2 nathanw if (sc->as_chipc == NULL) 781 1.10.2.2 nathanw return ENXIO; 782 1.10.2.2 nathanw 783 1.10.2.2 nathanw if (!sc->as_isopen) 784 1.10.2.2 nathanw sc->as_isopen = 1; 785 1.10.2.2 nathanw else 786 1.10.2.2 nathanw return EBUSY; 787 1.10.2.2 nathanw 788 1.10.2.2 nathanw return 0; 789 1.10.2.2 nathanw } 790 1.10.2.2 nathanw 791 1.10.2.2 nathanw int 792 1.10.2.2 nathanw agpclose(dev_t dev, int fflag, int devtype, struct proc *p) 793 1.10.2.2 nathanw { 794 1.10.2.2 nathanw struct agp_softc *sc = device_lookup(&agp_cd, AGPUNIT(dev)); 795 1.10.2.2 nathanw 796 1.10.2.2 nathanw /* 797 1.10.2.2 nathanw * Clear the GATT and force release on last close 798 1.10.2.2 nathanw */ 799 1.10.2.2 nathanw if (sc->as_state == AGP_ACQUIRE_USER) 800 1.10.2.2 nathanw agp_release_helper(sc, AGP_ACQUIRE_USER); 801 1.10.2.2 nathanw sc->as_isopen = 0; 802 1.10.2.2 nathanw 803 1.10.2.2 nathanw return 0; 804 1.10.2.2 nathanw } 805 1.10.2.2 nathanw 806 1.10.2.2 nathanw int 807 1.10.2.2 nathanw agpioctl(dev_t dev, u_long cmd, caddr_t data, int fflag, struct proc *p) 808 1.10.2.2 nathanw { 809 1.10.2.2 nathanw struct agp_softc *sc = device_lookup(&agp_cd, AGPUNIT(dev)); 810 1.10.2.2 nathanw 811 1.10.2.2 nathanw if (sc == NULL) 812 1.10.2.2 nathanw return ENODEV; 813 1.10.2.2 nathanw 814 1.10.2.2 nathanw if ((fflag & FWRITE) == 0 && cmd != AGPIOC_INFO) 815 1.10.2.2 nathanw return EPERM; 816 1.10.2.2 nathanw 817 1.10.2.2 nathanw switch (cmd) { 818 1.10.2.2 nathanw case AGPIOC_INFO: 819 1.10.2.2 nathanw return agp_info_user(sc, (agp_info *) data); 820 1.10.2.2 nathanw 821 1.10.2.2 nathanw case AGPIOC_ACQUIRE: 822 1.10.2.2 nathanw return agp_acquire_helper(sc, AGP_ACQUIRE_USER); 823 1.10.2.2 nathanw 824 1.10.2.2 nathanw case AGPIOC_RELEASE: 825 1.10.2.2 nathanw return agp_release_helper(sc, AGP_ACQUIRE_USER); 826 1.10.2.2 nathanw 827 1.10.2.2 nathanw case AGPIOC_SETUP: 828 1.10.2.2 nathanw return agp_setup_user(sc, (agp_setup *)data); 829 1.10.2.2 nathanw 830 1.10.2.2 nathanw case AGPIOC_ALLOCATE: 831 1.10.2.2 nathanw return agp_allocate_user(sc, (agp_allocate *)data); 832 1.10.2.2 nathanw 833 1.10.2.2 nathanw case AGPIOC_DEALLOCATE: 834 1.10.2.2 nathanw return agp_deallocate_user(sc, *(int *) data); 835 1.10.2.2 nathanw 836 1.10.2.2 nathanw case AGPIOC_BIND: 837 1.10.2.2 nathanw return agp_bind_user(sc, (agp_bind *)data); 838 1.10.2.2 nathanw 839 1.10.2.2 nathanw case AGPIOC_UNBIND: 840 1.10.2.2 nathanw return agp_unbind_user(sc, (agp_unbind *)data); 841 1.10.2.2 nathanw 842 1.10.2.2 nathanw } 843 1.10.2.2 nathanw 844 1.10.2.2 nathanw return EINVAL; 845 1.10.2.2 nathanw } 846 1.10.2.2 nathanw 847 1.10.2.2 nathanw paddr_t 848 1.10.2.2 nathanw agpmmap(dev_t dev, off_t offset, int prot) 849 1.10.2.2 nathanw { 850 1.10.2.2 nathanw struct agp_softc *sc = device_lookup(&agp_cd, AGPUNIT(dev)); 851 1.10.2.2 nathanw 852 1.10.2.2 nathanw if (offset > AGP_GET_APERTURE(sc)) 853 1.10.2.2 nathanw return -1; 854 1.10.2.2 nathanw 855 1.10.2.2 nathanw return (bus_space_mmap(sc->as_apt, sc->as_apaddr, offset, prot, 856 1.10.2.2 nathanw BUS_SPACE_MAP_LINEAR)); 857 1.10.2.2 nathanw } 858 1.10.2.2 nathanw 859 1.10.2.2 nathanw /* Implementation of the kernel api */ 860 1.10.2.2 nathanw 861 1.10.2.2 nathanw void * 862 1.10.2.2 nathanw agp_find_device(int unit) 863 1.10.2.2 nathanw { 864 1.10.2.2 nathanw return device_lookup(&agp_cd, unit); 865 1.10.2.2 nathanw } 866 1.10.2.2 nathanw 867 1.10.2.2 nathanw enum agp_acquire_state 868 1.10.2.2 nathanw agp_state(void *devcookie) 869 1.10.2.2 nathanw { 870 1.10.2.2 nathanw struct agp_softc *sc = devcookie; 871 1.10.2.2 nathanw return sc->as_state; 872 1.10.2.2 nathanw } 873 1.10.2.2 nathanw 874 1.10.2.2 nathanw void 875 1.10.2.2 nathanw agp_get_info(void *devcookie, struct agp_info *info) 876 1.10.2.2 nathanw { 877 1.10.2.2 nathanw struct agp_softc *sc = devcookie; 878 1.10.2.2 nathanw 879 1.10.2.2 nathanw info->ai_mode = pci_conf_read(sc->as_pc, sc->as_tag, 880 1.10.2.2 nathanw sc->as_capoff + AGP_STATUS); 881 1.10.2.2 nathanw info->ai_aperture_base = sc->as_apaddr; 882 1.10.2.2 nathanw info->ai_aperture_size = sc->as_apsize; /* XXXfvdl inconsistent */ 883 1.10.2.2 nathanw info->ai_memory_allowed = sc->as_maxmem; 884 1.10.2.2 nathanw info->ai_memory_used = sc->as_allocated; 885 1.10.2.2 nathanw } 886 1.10.2.2 nathanw 887 1.10.2.2 nathanw int 888 1.10.2.2 nathanw agp_acquire(void *dev) 889 1.10.2.2 nathanw { 890 1.10.2.2 nathanw return agp_acquire_helper(dev, AGP_ACQUIRE_KERNEL); 891 1.10.2.2 nathanw } 892 1.10.2.2 nathanw 893 1.10.2.2 nathanw int 894 1.10.2.2 nathanw agp_release(void *dev) 895 1.10.2.2 nathanw { 896 1.10.2.2 nathanw return agp_release_helper(dev, AGP_ACQUIRE_KERNEL); 897 1.10.2.2 nathanw } 898 1.10.2.2 nathanw 899 1.10.2.2 nathanw int 900 1.10.2.2 nathanw agp_enable(void *dev, u_int32_t mode) 901 1.10.2.2 nathanw { 902 1.10.2.2 nathanw struct agp_softc *sc = dev; 903 1.10.2.2 nathanw 904 1.10.2.2 nathanw return AGP_ENABLE(sc, mode); 905 1.10.2.2 nathanw } 906 1.10.2.2 nathanw 907 1.10.2.2 nathanw void *agp_alloc_memory(void *dev, int type, vsize_t bytes) 908 1.10.2.2 nathanw { 909 1.10.2.2 nathanw struct agp_softc *sc = dev; 910 1.10.2.2 nathanw 911 1.10.2.2 nathanw return (void *)AGP_ALLOC_MEMORY(sc, type, bytes); 912 1.10.2.2 nathanw } 913 1.10.2.2 nathanw 914 1.10.2.2 nathanw void agp_free_memory(void *dev, void *handle) 915 1.10.2.2 nathanw { 916 1.10.2.2 nathanw struct agp_softc *sc = dev; 917 1.10.2.2 nathanw struct agp_memory *mem = (struct agp_memory *) handle; 918 1.10.2.2 nathanw AGP_FREE_MEMORY(sc, mem); 919 1.10.2.2 nathanw } 920 1.10.2.2 nathanw 921 1.10.2.2 nathanw int agp_bind_memory(void *dev, void *handle, off_t offset) 922 1.10.2.2 nathanw { 923 1.10.2.2 nathanw struct agp_softc *sc = dev; 924 1.10.2.2 nathanw struct agp_memory *mem = (struct agp_memory *) handle; 925 1.10.2.2 nathanw 926 1.10.2.2 nathanw return AGP_BIND_MEMORY(sc, mem, offset); 927 1.10.2.2 nathanw } 928 1.10.2.2 nathanw 929 1.10.2.2 nathanw int agp_unbind_memory(void *dev, void *handle) 930 1.10.2.2 nathanw { 931 1.10.2.2 nathanw struct agp_softc *sc = dev; 932 1.10.2.2 nathanw struct agp_memory *mem = (struct agp_memory *) handle; 933 1.10.2.2 nathanw 934 1.10.2.2 nathanw return AGP_UNBIND_MEMORY(sc, mem); 935 1.10.2.2 nathanw } 936 1.10.2.2 nathanw 937 1.10.2.2 nathanw void agp_memory_info(void *dev, void *handle, struct agp_memory_info *mi) 938 1.10.2.2 nathanw { 939 1.10.2.2 nathanw struct agp_memory *mem = (struct agp_memory *) handle; 940 1.10.2.2 nathanw 941 1.10.2.2 nathanw mi->ami_size = mem->am_size; 942 1.10.2.2 nathanw mi->ami_physical = mem->am_physical; 943 1.10.2.2 nathanw mi->ami_offset = mem->am_offset; 944 1.10.2.2 nathanw mi->ami_is_bound = mem->am_is_bound; 945 1.10.2.2 nathanw } 946 1.10.2.2 nathanw 947 1.10.2.2 nathanw int 948 1.10.2.2 nathanw agp_alloc_dmamem(bus_dma_tag_t tag, size_t size, int flags, 949 1.10.2.2 nathanw bus_dmamap_t *mapp, caddr_t *vaddr, bus_addr_t *baddr, 950 1.10.2.2 nathanw bus_dma_segment_t *seg, int nseg, int *rseg) 951 1.10.2.2 nathanw 952 1.10.2.2 nathanw { 953 1.10.2.2 nathanw int error, level = 0; 954 1.10.2.2 nathanw 955 1.10.2.2 nathanw if ((error = bus_dmamem_alloc(tag, size, PAGE_SIZE, 0, 956 1.10.2.2 nathanw seg, nseg, rseg, BUS_DMA_NOWAIT)) != 0) 957 1.10.2.2 nathanw goto out; 958 1.10.2.2 nathanw level++; 959 1.10.2.2 nathanw 960 1.10.2.2 nathanw if ((error = bus_dmamem_map(tag, seg, *rseg, size, vaddr, 961 1.10.2.2 nathanw BUS_DMA_NOWAIT | flags)) != 0) 962 1.10.2.2 nathanw goto out; 963 1.10.2.2 nathanw level++; 964 1.10.2.2 nathanw 965 1.10.2.2 nathanw if ((error = bus_dmamap_create(tag, size, *rseg, size, 0, 966 1.10.2.2 nathanw BUS_DMA_NOWAIT, mapp)) != 0) 967 1.10.2.2 nathanw goto out; 968 1.10.2.2 nathanw level++; 969 1.10.2.2 nathanw 970 1.10.2.2 nathanw if ((error = bus_dmamap_load(tag, *mapp, *vaddr, size, NULL, 971 1.10.2.2 nathanw BUS_DMA_NOWAIT)) != 0) 972 1.10.2.2 nathanw goto out; 973 1.10.2.2 nathanw 974 1.10.2.2 nathanw *baddr = (*mapp)->dm_segs[0].ds_addr; 975 1.10.2.2 nathanw 976 1.10.2.2 nathanw return 0; 977 1.10.2.2 nathanw out: 978 1.10.2.2 nathanw switch (level) { 979 1.10.2.2 nathanw case 3: 980 1.10.2.2 nathanw bus_dmamap_destroy(tag, *mapp); 981 1.10.2.2 nathanw /* FALLTHROUGH */ 982 1.10.2.2 nathanw case 2: 983 1.10.2.2 nathanw bus_dmamem_unmap(tag, *vaddr, size); 984 1.10.2.2 nathanw /* FALLTHROUGH */ 985 1.10.2.2 nathanw case 1: 986 1.10.2.2 nathanw bus_dmamem_free(tag, seg, *rseg); 987 1.10.2.2 nathanw break; 988 1.10.2.2 nathanw default: 989 1.10.2.2 nathanw break; 990 1.10.2.2 nathanw } 991 1.10.2.2 nathanw 992 1.10.2.2 nathanw return error; 993 1.10.2.2 nathanw } 994 1.10.2.2 nathanw 995 1.10.2.2 nathanw void 996 1.10.2.2 nathanw agp_free_dmamem(bus_dma_tag_t tag, size_t size, bus_dmamap_t map, 997 1.10.2.2 nathanw caddr_t vaddr, bus_dma_segment_t *seg, int nseg) 998 1.10.2.2 nathanw { 999 1.10.2.2 nathanw 1000 1.10.2.2 nathanw bus_dmamap_unload(tag, map); 1001 1.10.2.2 nathanw bus_dmamap_destroy(tag, map); 1002 1.10.2.2 nathanw bus_dmamem_unmap(tag, vaddr, size); 1003 1.10.2.2 nathanw bus_dmamem_free(tag, seg, nseg); 1004 1.10.2.2 nathanw } 1005
Indexes created Thu Oct 16 14:10:15 GMT 2025