30#include "opt_bus.h" 31 32#include <sys/param.h> 33#include <sys/systm.h> 34#include <sys/malloc.h> 35#include <sys/kernel.h> 36#include <sys/module.h> 37#include <sys/bus.h> 38#include <sys/conf.h> 39#include <sys/ioccom.h> 40#include <sys/agpio.h> 41#include <sys/lock.h> 42#include <sys/mutex.h> 43#include <sys/proc.h> 44 45#include <dev/agp/agppriv.h> 46#include <dev/agp/agpvar.h> 47#include <dev/agp/agpreg.h> 48#include <dev/pci/pcivar.h> 49#include <dev/pci/pcireg.h> 50 51#include <vm/vm.h> 52#include <vm/vm_object.h> 53#include <vm/vm_page.h> 54#include <vm/vm_pageout.h> 55#include <vm/pmap.h> 56 57#include <machine/md_var.h> 58#include <machine/bus.h> 59#include <machine/resource.h> 60#include <sys/rman.h> 61 62MODULE_VERSION(agp, 1); 63 64MALLOC_DEFINE(M_AGP, "agp", "AGP data structures"); 65 66 /* agp_drv.c */ 67static d_open_t agp_open; 68static d_close_t agp_close; 69static d_ioctl_t agp_ioctl; 70static d_mmap_t agp_mmap; 71 72static struct cdevsw agp_cdevsw = { 73 .d_version = D_VERSION, 74 .d_flags = D_NEEDGIANT, 75 .d_open = agp_open, 76 .d_close = agp_close, 77 .d_ioctl = agp_ioctl, 78 .d_mmap = agp_mmap, 79 .d_name = "agp", 80}; 81 82static devclass_t agp_devclass; 83#define KDEV2DEV(kdev) devclass_get_device(agp_devclass, dev2unit(kdev)) 84 85/* Helper functions for implementing chipset mini drivers. */ 86 87void 88agp_flush_cache() 89{ 90#if defined(__i386__) || defined(__amd64__) 91 wbinvd(); 92#endif 93} 94 95u_int8_t 96agp_find_caps(device_t dev) 97{ 98 int capreg; 99 100 101 if (pci_find_extcap(dev, PCIY_AGP, &capreg) != 0) 102 capreg = 0; 103 return (capreg); 104} 105 106/* 107 * Find an AGP display device (if any). 108 */ 109static device_t 110agp_find_display(void) 111{ 112 devclass_t pci = devclass_find("pci"); 113 device_t bus, dev = 0; 114 device_t *kids; 115 int busnum, numkids, i; 116 117 for (busnum = 0; busnum < devclass_get_maxunit(pci); busnum++) { 118 bus = devclass_get_device(pci, busnum); 119 if (!bus) 120 continue; 121 if (device_get_children(bus, &kids, &numkids) != 0) 122 continue; 123 for (i = 0; i < numkids; i++) { 124 dev = kids[i]; 125 if (pci_get_class(dev) == PCIC_DISPLAY 126 && pci_get_subclass(dev) == PCIS_DISPLAY_VGA) 127 if (agp_find_caps(dev)) { 128 free(kids, M_TEMP); 129 return dev; 130 } 131 132 } 133 free(kids, M_TEMP); 134 } 135 136 return 0; 137} 138 139struct agp_gatt * 140agp_alloc_gatt(device_t dev) 141{ 142 u_int32_t apsize = AGP_GET_APERTURE(dev); 143 u_int32_t entries = apsize >> AGP_PAGE_SHIFT; 144 struct agp_gatt *gatt; 145 146 if (bootverbose) 147 device_printf(dev, 148 "allocating GATT for aperture of size %dM\n", 149 apsize / (1024*1024)); 150 151 if (entries == 0) { 152 device_printf(dev, "bad aperture size\n"); 153 return NULL; 154 } 155 156 gatt = malloc(sizeof(struct agp_gatt), M_AGP, M_NOWAIT); 157 if (!gatt) 158 return 0; 159 160 gatt->ag_entries = entries; 161 gatt->ag_virtual = contigmalloc(entries * sizeof(u_int32_t), M_AGP, 0, 162 0, ~0, PAGE_SIZE, 0); 163 if (!gatt->ag_virtual) { 164 if (bootverbose) 165 device_printf(dev, "contiguous allocation failed\n"); 166 free(gatt, M_AGP); 167 return 0; 168 } 169 bzero(gatt->ag_virtual, entries * sizeof(u_int32_t)); 170 gatt->ag_physical = vtophys((vm_offset_t) gatt->ag_virtual); 171 agp_flush_cache(); 172 173 return gatt; 174} 175 176void 177agp_free_gatt(struct agp_gatt *gatt) 178{ 179 contigfree(gatt->ag_virtual, 180 gatt->ag_entries * sizeof(u_int32_t), M_AGP); 181 free(gatt, M_AGP); 182} 183 184static u_int agp_max[][2] = { 185 {0, 0}, 186 {32, 4}, 187 {64, 28}, 188 {128, 96}, 189 {256, 204}, 190 {512, 440}, 191 {1024, 942}, 192 {2048, 1920}, 193 {4096, 3932} 194}; 195#define agp_max_size (sizeof(agp_max) / sizeof(agp_max[0])) 196 197/** 198 * Sets the PCI resource which represents the AGP aperture. 199 * 200 * If not called, the default AGP aperture resource of AGP_APBASE will 201 * be used. Must be called before agp_generic_attach(). 202 */ 203void 204agp_set_aperture_resource(device_t dev, int rid) 205{ 206 struct agp_softc *sc = device_get_softc(dev); 207 208 sc->as_aperture_rid = rid; 209} 210 211int 212agp_generic_attach(device_t dev) 213{ 214 struct agp_softc *sc = device_get_softc(dev); 215 int i; 216 u_int memsize; 217 218 /* 219 * Find and map the aperture, RF_SHAREABLE for DRM but not RF_ACTIVE 220 * because the kernel doesn't need to map it. 221 */ 222 if (sc->as_aperture_rid == 0) 223 sc->as_aperture_rid = AGP_APBASE; 224 225 sc->as_aperture = bus_alloc_resource_any(dev, SYS_RES_MEMORY, 226 &sc->as_aperture_rid, RF_SHAREABLE); 227 if (!sc->as_aperture) 228 return ENOMEM; 229 230 /* 231 * Work out an upper bound for agp memory allocation. This 232 * uses a heurisitc table from the Linux driver. 233 */ 234 memsize = ptoa(Maxmem) >> 20; 235 for (i = 0; i < agp_max_size; i++) { 236 if (memsize <= agp_max[i][0]) 237 break; 238 } 239 if (i == agp_max_size) i = agp_max_size - 1; 240 sc->as_maxmem = agp_max[i][1] << 20U; 241 242 /* 243 * The lock is used to prevent re-entry to 244 * agp_generic_bind_memory() since that function can sleep. 245 */ 246 mtx_init(&sc->as_lock, "agp lock", NULL, MTX_DEF); 247 248 /* 249 * Initialise stuff for the userland device. 250 */ 251 agp_devclass = devclass_find("agp"); 252 TAILQ_INIT(&sc->as_memory); 253 sc->as_nextid = 1; 254 255 sc->as_devnode = make_dev(&agp_cdevsw, 256 device_get_unit(dev), 257 UID_ROOT, 258 GID_WHEEL, 259 0600, 260 "agpgart"); 261 262 return 0; 263} 264 265void 266agp_free_cdev(device_t dev) 267{ 268 struct agp_softc *sc = device_get_softc(dev); 269 270 destroy_dev(sc->as_devnode); 271} 272 273void 274agp_free_res(device_t dev) 275{ 276 struct agp_softc *sc = device_get_softc(dev); 277 278 bus_release_resource(dev, SYS_RES_MEMORY, sc->as_aperture_rid, 279 sc->as_aperture); 280 mtx_destroy(&sc->as_lock); 281 agp_flush_cache(); 282} 283 284int 285agp_generic_detach(device_t dev) 286{ 287 288 agp_free_cdev(dev); 289 agp_free_res(dev); 290 return 0; 291} 292 293/** 294 * Default AGP aperture size detection which simply returns the size of 295 * the aperture's PCI resource. 296 */ 297int 298agp_generic_get_aperture(device_t dev) 299{ 300 struct agp_softc *sc = device_get_softc(dev); 301 302 return rman_get_size(sc->as_aperture); 303} 304 305/** 306 * Default AGP aperture size setting function, which simply doesn't allow 307 * changes to resource size. 308 */ 309int 310agp_generic_set_aperture(device_t dev, u_int32_t aperture) 311{ 312 u_int32_t current_aperture; 313 314 current_aperture = AGP_GET_APERTURE(dev); 315 if (current_aperture != aperture) 316 return EINVAL; 317 else 318 return 0; 319} 320 321/* 322 * This does the enable logic for v3, with the same topology 323 * restrictions as in place for v2 -- one bus, one device on the bus. 324 */ 325static int 326agp_v3_enable(device_t dev, device_t mdev, u_int32_t mode) 327{ 328 u_int32_t tstatus, mstatus; 329 u_int32_t command; 330 int rq, sba, fw, rate, arqsz, cal; 331 332 tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 333 mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4); 334 335 /* Set RQ to the min of mode, tstatus and mstatus */ 336 rq = AGP_MODE_GET_RQ(mode); 337 if (AGP_MODE_GET_RQ(tstatus) < rq) 338 rq = AGP_MODE_GET_RQ(tstatus); 339 if (AGP_MODE_GET_RQ(mstatus) < rq) 340 rq = AGP_MODE_GET_RQ(mstatus); 341 342 /* 343 * ARQSZ - Set the value to the maximum one. 344 * Don't allow the mode register to override values. 345 */ 346 arqsz = AGP_MODE_GET_ARQSZ(mode); 347 if (AGP_MODE_GET_ARQSZ(tstatus) > rq) 348 rq = AGP_MODE_GET_ARQSZ(tstatus); 349 if (AGP_MODE_GET_ARQSZ(mstatus) > rq) 350 rq = AGP_MODE_GET_ARQSZ(mstatus); 351 352 /* Calibration cycle - don't allow override by mode register */ 353 cal = AGP_MODE_GET_CAL(tstatus); 354 if (AGP_MODE_GET_CAL(mstatus) < cal) 355 cal = AGP_MODE_GET_CAL(mstatus); 356 357 /* SBA must be supported for AGP v3. */ 358 sba = 1; 359 360 /* Set FW if all three support it. */ 361 fw = (AGP_MODE_GET_FW(tstatus) 362 & AGP_MODE_GET_FW(mstatus) 363 & AGP_MODE_GET_FW(mode)); 364 365 /* Figure out the max rate */ 366 rate = (AGP_MODE_GET_RATE(tstatus) 367 & AGP_MODE_GET_RATE(mstatus) 368 & AGP_MODE_GET_RATE(mode)); 369 if (rate & AGP_MODE_V3_RATE_8x) 370 rate = AGP_MODE_V3_RATE_8x; 371 else 372 rate = AGP_MODE_V3_RATE_4x; 373 if (bootverbose) 374 device_printf(dev, "Setting AGP v3 mode %d\n", rate * 4); 375 376 pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, 0, 4); 377 378 /* Construct the new mode word and tell the hardware */ 379 command = 0; 380 command = AGP_MODE_SET_RQ(0, rq); 381 command = AGP_MODE_SET_ARQSZ(command, arqsz); 382 command = AGP_MODE_SET_CAL(command, cal); 383 command = AGP_MODE_SET_SBA(command, sba); 384 command = AGP_MODE_SET_FW(command, fw); 385 command = AGP_MODE_SET_RATE(command, rate); 386 command = AGP_MODE_SET_MODE_3(command, 1); 387 command = AGP_MODE_SET_AGP(command, 1); 388 pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, command, 4); 389 pci_write_config(mdev, agp_find_caps(mdev) + AGP_COMMAND, command, 4); 390 391 return 0; 392} 393 394static int 395agp_v2_enable(device_t dev, device_t mdev, u_int32_t mode) 396{ 397 u_int32_t tstatus, mstatus; 398 u_int32_t command; 399 int rq, sba, fw, rate; 400 401 tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 402 mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4); 403 404 /* Set RQ to the min of mode, tstatus and mstatus */ 405 rq = AGP_MODE_GET_RQ(mode); 406 if (AGP_MODE_GET_RQ(tstatus) < rq) 407 rq = AGP_MODE_GET_RQ(tstatus); 408 if (AGP_MODE_GET_RQ(mstatus) < rq) 409 rq = AGP_MODE_GET_RQ(mstatus); 410 411 /* Set SBA if all three can deal with SBA */ 412 sba = (AGP_MODE_GET_SBA(tstatus) 413 & AGP_MODE_GET_SBA(mstatus) 414 & AGP_MODE_GET_SBA(mode)); 415 416 /* Similar for FW */ 417 fw = (AGP_MODE_GET_FW(tstatus) 418 & AGP_MODE_GET_FW(mstatus) 419 & AGP_MODE_GET_FW(mode)); 420 421 /* Figure out the max rate */ 422 rate = (AGP_MODE_GET_RATE(tstatus) 423 & AGP_MODE_GET_RATE(mstatus) 424 & AGP_MODE_GET_RATE(mode)); 425 if (rate & AGP_MODE_V2_RATE_4x) 426 rate = AGP_MODE_V2_RATE_4x; 427 else if (rate & AGP_MODE_V2_RATE_2x) 428 rate = AGP_MODE_V2_RATE_2x; 429 else 430 rate = AGP_MODE_V2_RATE_1x; 431 if (bootverbose) 432 device_printf(dev, "Setting AGP v2 mode %d\n", rate); 433 434 /* Construct the new mode word and tell the hardware */ 435 command = 0; 436 command = AGP_MODE_SET_RQ(0, rq); 437 command = AGP_MODE_SET_SBA(command, sba); 438 command = AGP_MODE_SET_FW(command, fw); 439 command = AGP_MODE_SET_RATE(command, rate); 440 command = AGP_MODE_SET_AGP(command, 1); 441 pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, command, 4); 442 pci_write_config(mdev, agp_find_caps(mdev) + AGP_COMMAND, command, 4); 443 444 return 0; 445} 446 447int 448agp_generic_enable(device_t dev, u_int32_t mode) 449{ 450 device_t mdev = agp_find_display(); 451 u_int32_t tstatus, mstatus; 452 453 if (!mdev) { 454 AGP_DPF("can't find display\n"); 455 return ENXIO; 456 } 457 458 tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 459 mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4); 460 461 /* 462 * Check display and bridge for AGP v3 support. AGP v3 allows 463 * more variety in topology than v2, e.g. multiple AGP devices 464 * attached to one bridge, or multiple AGP bridges in one 465 * system. This doesn't attempt to address those situations, 466 * but should work fine for a classic single AGP slot system 467 * with AGP v3. 468 */ 469 if (AGP_MODE_GET_MODE_3(mode) && 470 AGP_MODE_GET_MODE_3(tstatus) && 471 AGP_MODE_GET_MODE_3(mstatus)) 472 return (agp_v3_enable(dev, mdev, mode)); 473 else 474 return (agp_v2_enable(dev, mdev, mode)); 475} 476 477struct agp_memory * 478agp_generic_alloc_memory(device_t dev, int type, vm_size_t size) 479{ 480 struct agp_softc *sc = device_get_softc(dev); 481 struct agp_memory *mem; 482 483 if ((size & (AGP_PAGE_SIZE - 1)) != 0) 484 return 0; 485 486 if (sc->as_allocated + size > sc->as_maxmem) 487 return 0; 488 489 if (type != 0) { 490 printf("agp_generic_alloc_memory: unsupported type %d\n", 491 type); 492 return 0; 493 } 494 495 mem = malloc(sizeof *mem, M_AGP, M_WAITOK); 496 mem->am_id = sc->as_nextid++; 497 mem->am_size = size; 498 mem->am_type = 0; 499 mem->am_obj = vm_object_allocate(OBJT_DEFAULT, atop(round_page(size))); 500 mem->am_physical = 0; 501 mem->am_offset = 0; 502 mem->am_is_bound = 0; 503 TAILQ_INSERT_TAIL(&sc->as_memory, mem, am_link); 504 sc->as_allocated += size; 505 506 return mem; 507} 508 509int 510agp_generic_free_memory(device_t dev, struct agp_memory *mem) 511{ 512 struct agp_softc *sc = device_get_softc(dev); 513 514 if (mem->am_is_bound) 515 return EBUSY; 516 517 sc->as_allocated -= mem->am_size; 518 TAILQ_REMOVE(&sc->as_memory, mem, am_link); 519 vm_object_deallocate(mem->am_obj); 520 free(mem, M_AGP); 521 return 0; 522} 523 524int 525agp_generic_bind_memory(device_t dev, struct agp_memory *mem, 526 vm_offset_t offset) 527{ 528 struct agp_softc *sc = device_get_softc(dev); 529 vm_offset_t i, j, k; 530 vm_page_t m; 531 int error; 532 533 /* Do some sanity checks first. */ 534 if (offset < 0 || (offset & (AGP_PAGE_SIZE - 1)) != 0 || 535 offset + mem->am_size > AGP_GET_APERTURE(dev)) { 536 device_printf(dev, "binding memory at bad offset %#x\n", 537 (int)offset); 538 return EINVAL; 539 } 540 541 /* 542 * Allocate the pages early, before acquiring the lock, 543 * because vm_page_grab() used with VM_ALLOC_RETRY may 544 * block and we can't hold a mutex while blocking. 545 */ 546 VM_OBJECT_LOCK(mem->am_obj); 547 for (i = 0; i < mem->am_size; i += PAGE_SIZE) { 548 /* 549 * Find a page from the object and wire it 550 * down. This page will be mapped using one or more 551 * entries in the GATT (assuming that PAGE_SIZE >= 552 * AGP_PAGE_SIZE. If this is the first call to bind, 553 * the pages will be allocated and zeroed. 554 */ 555 m = vm_page_grab(mem->am_obj, OFF_TO_IDX(i), 556 VM_ALLOC_WIRED | VM_ALLOC_ZERO | VM_ALLOC_RETRY);
| 31#include "opt_bus.h" 32 33#include <sys/param.h> 34#include <sys/systm.h> 35#include <sys/malloc.h> 36#include <sys/kernel.h> 37#include <sys/module.h> 38#include <sys/bus.h> 39#include <sys/conf.h> 40#include <sys/ioccom.h> 41#include <sys/agpio.h> 42#include <sys/lock.h> 43#include <sys/mutex.h> 44#include <sys/proc.h> 45 46#include <dev/agp/agppriv.h> 47#include <dev/agp/agpvar.h> 48#include <dev/agp/agpreg.h> 49#include <dev/pci/pcivar.h> 50#include <dev/pci/pcireg.h> 51 52#include <vm/vm.h> 53#include <vm/vm_object.h> 54#include <vm/vm_page.h> 55#include <vm/vm_pageout.h> 56#include <vm/pmap.h> 57 58#include <machine/md_var.h> 59#include <machine/bus.h> 60#include <machine/resource.h> 61#include <sys/rman.h> 62 63MODULE_VERSION(agp, 1); 64 65MALLOC_DEFINE(M_AGP, "agp", "AGP data structures"); 66 67 /* agp_drv.c */ 68static d_open_t agp_open; 69static d_close_t agp_close; 70static d_ioctl_t agp_ioctl; 71static d_mmap_t agp_mmap; 72 73static struct cdevsw agp_cdevsw = { 74 .d_version = D_VERSION, 75 .d_flags = D_NEEDGIANT, 76 .d_open = agp_open, 77 .d_close = agp_close, 78 .d_ioctl = agp_ioctl, 79 .d_mmap = agp_mmap, 80 .d_name = "agp", 81}; 82 83static devclass_t agp_devclass; 84#define KDEV2DEV(kdev) devclass_get_device(agp_devclass, dev2unit(kdev)) 85 86/* Helper functions for implementing chipset mini drivers. */ 87 88void 89agp_flush_cache() 90{ 91#if defined(__i386__) || defined(__amd64__) 92 wbinvd(); 93#endif 94} 95 96u_int8_t 97agp_find_caps(device_t dev) 98{ 99 int capreg; 100 101 102 if (pci_find_extcap(dev, PCIY_AGP, &capreg) != 0) 103 capreg = 0; 104 return (capreg); 105} 106 107/* 108 * Find an AGP display device (if any). 109 */ 110static device_t 111agp_find_display(void) 112{ 113 devclass_t pci = devclass_find("pci"); 114 device_t bus, dev = 0; 115 device_t *kids; 116 int busnum, numkids, i; 117 118 for (busnum = 0; busnum < devclass_get_maxunit(pci); busnum++) { 119 bus = devclass_get_device(pci, busnum); 120 if (!bus) 121 continue; 122 if (device_get_children(bus, &kids, &numkids) != 0) 123 continue; 124 for (i = 0; i < numkids; i++) { 125 dev = kids[i]; 126 if (pci_get_class(dev) == PCIC_DISPLAY 127 && pci_get_subclass(dev) == PCIS_DISPLAY_VGA) 128 if (agp_find_caps(dev)) { 129 free(kids, M_TEMP); 130 return dev; 131 } 132 133 } 134 free(kids, M_TEMP); 135 } 136 137 return 0; 138} 139 140struct agp_gatt * 141agp_alloc_gatt(device_t dev) 142{ 143 u_int32_t apsize = AGP_GET_APERTURE(dev); 144 u_int32_t entries = apsize >> AGP_PAGE_SHIFT; 145 struct agp_gatt *gatt; 146 147 if (bootverbose) 148 device_printf(dev, 149 "allocating GATT for aperture of size %dM\n", 150 apsize / (1024*1024)); 151 152 if (entries == 0) { 153 device_printf(dev, "bad aperture size\n"); 154 return NULL; 155 } 156 157 gatt = malloc(sizeof(struct agp_gatt), M_AGP, M_NOWAIT); 158 if (!gatt) 159 return 0; 160 161 gatt->ag_entries = entries; 162 gatt->ag_virtual = contigmalloc(entries * sizeof(u_int32_t), M_AGP, 0, 163 0, ~0, PAGE_SIZE, 0); 164 if (!gatt->ag_virtual) { 165 if (bootverbose) 166 device_printf(dev, "contiguous allocation failed\n"); 167 free(gatt, M_AGP); 168 return 0; 169 } 170 bzero(gatt->ag_virtual, entries * sizeof(u_int32_t)); 171 gatt->ag_physical = vtophys((vm_offset_t) gatt->ag_virtual); 172 agp_flush_cache(); 173 174 return gatt; 175} 176 177void 178agp_free_gatt(struct agp_gatt *gatt) 179{ 180 contigfree(gatt->ag_virtual, 181 gatt->ag_entries * sizeof(u_int32_t), M_AGP); 182 free(gatt, M_AGP); 183} 184 185static u_int agp_max[][2] = { 186 {0, 0}, 187 {32, 4}, 188 {64, 28}, 189 {128, 96}, 190 {256, 204}, 191 {512, 440}, 192 {1024, 942}, 193 {2048, 1920}, 194 {4096, 3932} 195}; 196#define agp_max_size (sizeof(agp_max) / sizeof(agp_max[0])) 197 198/** 199 * Sets the PCI resource which represents the AGP aperture. 200 * 201 * If not called, the default AGP aperture resource of AGP_APBASE will 202 * be used. Must be called before agp_generic_attach(). 203 */ 204void 205agp_set_aperture_resource(device_t dev, int rid) 206{ 207 struct agp_softc *sc = device_get_softc(dev); 208 209 sc->as_aperture_rid = rid; 210} 211 212int 213agp_generic_attach(device_t dev) 214{ 215 struct agp_softc *sc = device_get_softc(dev); 216 int i; 217 u_int memsize; 218 219 /* 220 * Find and map the aperture, RF_SHAREABLE for DRM but not RF_ACTIVE 221 * because the kernel doesn't need to map it. 222 */ 223 if (sc->as_aperture_rid == 0) 224 sc->as_aperture_rid = AGP_APBASE; 225 226 sc->as_aperture = bus_alloc_resource_any(dev, SYS_RES_MEMORY, 227 &sc->as_aperture_rid, RF_SHAREABLE); 228 if (!sc->as_aperture) 229 return ENOMEM; 230 231 /* 232 * Work out an upper bound for agp memory allocation. This 233 * uses a heurisitc table from the Linux driver. 234 */ 235 memsize = ptoa(Maxmem) >> 20; 236 for (i = 0; i < agp_max_size; i++) { 237 if (memsize <= agp_max[i][0]) 238 break; 239 } 240 if (i == agp_max_size) i = agp_max_size - 1; 241 sc->as_maxmem = agp_max[i][1] << 20U; 242 243 /* 244 * The lock is used to prevent re-entry to 245 * agp_generic_bind_memory() since that function can sleep. 246 */ 247 mtx_init(&sc->as_lock, "agp lock", NULL, MTX_DEF); 248 249 /* 250 * Initialise stuff for the userland device. 251 */ 252 agp_devclass = devclass_find("agp"); 253 TAILQ_INIT(&sc->as_memory); 254 sc->as_nextid = 1; 255 256 sc->as_devnode = make_dev(&agp_cdevsw, 257 device_get_unit(dev), 258 UID_ROOT, 259 GID_WHEEL, 260 0600, 261 "agpgart"); 262 263 return 0; 264} 265 266void 267agp_free_cdev(device_t dev) 268{ 269 struct agp_softc *sc = device_get_softc(dev); 270 271 destroy_dev(sc->as_devnode); 272} 273 274void 275agp_free_res(device_t dev) 276{ 277 struct agp_softc *sc = device_get_softc(dev); 278 279 bus_release_resource(dev, SYS_RES_MEMORY, sc->as_aperture_rid, 280 sc->as_aperture); 281 mtx_destroy(&sc->as_lock); 282 agp_flush_cache(); 283} 284 285int 286agp_generic_detach(device_t dev) 287{ 288 289 agp_free_cdev(dev); 290 agp_free_res(dev); 291 return 0; 292} 293 294/** 295 * Default AGP aperture size detection which simply returns the size of 296 * the aperture's PCI resource. 297 */ 298int 299agp_generic_get_aperture(device_t dev) 300{ 301 struct agp_softc *sc = device_get_softc(dev); 302 303 return rman_get_size(sc->as_aperture); 304} 305 306/** 307 * Default AGP aperture size setting function, which simply doesn't allow 308 * changes to resource size. 309 */ 310int 311agp_generic_set_aperture(device_t dev, u_int32_t aperture) 312{ 313 u_int32_t current_aperture; 314 315 current_aperture = AGP_GET_APERTURE(dev); 316 if (current_aperture != aperture) 317 return EINVAL; 318 else 319 return 0; 320} 321 322/* 323 * This does the enable logic for v3, with the same topology 324 * restrictions as in place for v2 -- one bus, one device on the bus. 325 */ 326static int 327agp_v3_enable(device_t dev, device_t mdev, u_int32_t mode) 328{ 329 u_int32_t tstatus, mstatus; 330 u_int32_t command; 331 int rq, sba, fw, rate, arqsz, cal; 332 333 tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 334 mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4); 335 336 /* Set RQ to the min of mode, tstatus and mstatus */ 337 rq = AGP_MODE_GET_RQ(mode); 338 if (AGP_MODE_GET_RQ(tstatus) < rq) 339 rq = AGP_MODE_GET_RQ(tstatus); 340 if (AGP_MODE_GET_RQ(mstatus) < rq) 341 rq = AGP_MODE_GET_RQ(mstatus); 342 343 /* 344 * ARQSZ - Set the value to the maximum one. 345 * Don't allow the mode register to override values. 346 */ 347 arqsz = AGP_MODE_GET_ARQSZ(mode); 348 if (AGP_MODE_GET_ARQSZ(tstatus) > rq) 349 rq = AGP_MODE_GET_ARQSZ(tstatus); 350 if (AGP_MODE_GET_ARQSZ(mstatus) > rq) 351 rq = AGP_MODE_GET_ARQSZ(mstatus); 352 353 /* Calibration cycle - don't allow override by mode register */ 354 cal = AGP_MODE_GET_CAL(tstatus); 355 if (AGP_MODE_GET_CAL(mstatus) < cal) 356 cal = AGP_MODE_GET_CAL(mstatus); 357 358 /* SBA must be supported for AGP v3. */ 359 sba = 1; 360 361 /* Set FW if all three support it. */ 362 fw = (AGP_MODE_GET_FW(tstatus) 363 & AGP_MODE_GET_FW(mstatus) 364 & AGP_MODE_GET_FW(mode)); 365 366 /* Figure out the max rate */ 367 rate = (AGP_MODE_GET_RATE(tstatus) 368 & AGP_MODE_GET_RATE(mstatus) 369 & AGP_MODE_GET_RATE(mode)); 370 if (rate & AGP_MODE_V3_RATE_8x) 371 rate = AGP_MODE_V3_RATE_8x; 372 else 373 rate = AGP_MODE_V3_RATE_4x; 374 if (bootverbose) 375 device_printf(dev, "Setting AGP v3 mode %d\n", rate * 4); 376 377 pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, 0, 4); 378 379 /* Construct the new mode word and tell the hardware */ 380 command = 0; 381 command = AGP_MODE_SET_RQ(0, rq); 382 command = AGP_MODE_SET_ARQSZ(command, arqsz); 383 command = AGP_MODE_SET_CAL(command, cal); 384 command = AGP_MODE_SET_SBA(command, sba); 385 command = AGP_MODE_SET_FW(command, fw); 386 command = AGP_MODE_SET_RATE(command, rate); 387 command = AGP_MODE_SET_MODE_3(command, 1); 388 command = AGP_MODE_SET_AGP(command, 1); 389 pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, command, 4); 390 pci_write_config(mdev, agp_find_caps(mdev) + AGP_COMMAND, command, 4); 391 392 return 0; 393} 394 395static int 396agp_v2_enable(device_t dev, device_t mdev, u_int32_t mode) 397{ 398 u_int32_t tstatus, mstatus; 399 u_int32_t command; 400 int rq, sba, fw, rate; 401 402 tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 403 mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4); 404 405 /* Set RQ to the min of mode, tstatus and mstatus */ 406 rq = AGP_MODE_GET_RQ(mode); 407 if (AGP_MODE_GET_RQ(tstatus) < rq) 408 rq = AGP_MODE_GET_RQ(tstatus); 409 if (AGP_MODE_GET_RQ(mstatus) < rq) 410 rq = AGP_MODE_GET_RQ(mstatus); 411 412 /* Set SBA if all three can deal with SBA */ 413 sba = (AGP_MODE_GET_SBA(tstatus) 414 & AGP_MODE_GET_SBA(mstatus) 415 & AGP_MODE_GET_SBA(mode)); 416 417 /* Similar for FW */ 418 fw = (AGP_MODE_GET_FW(tstatus) 419 & AGP_MODE_GET_FW(mstatus) 420 & AGP_MODE_GET_FW(mode)); 421 422 /* Figure out the max rate */ 423 rate = (AGP_MODE_GET_RATE(tstatus) 424 & AGP_MODE_GET_RATE(mstatus) 425 & AGP_MODE_GET_RATE(mode)); 426 if (rate & AGP_MODE_V2_RATE_4x) 427 rate = AGP_MODE_V2_RATE_4x; 428 else if (rate & AGP_MODE_V2_RATE_2x) 429 rate = AGP_MODE_V2_RATE_2x; 430 else 431 rate = AGP_MODE_V2_RATE_1x; 432 if (bootverbose) 433 device_printf(dev, "Setting AGP v2 mode %d\n", rate); 434 435 /* Construct the new mode word and tell the hardware */ 436 command = 0; 437 command = AGP_MODE_SET_RQ(0, rq); 438 command = AGP_MODE_SET_SBA(command, sba); 439 command = AGP_MODE_SET_FW(command, fw); 440 command = AGP_MODE_SET_RATE(command, rate); 441 command = AGP_MODE_SET_AGP(command, 1); 442 pci_write_config(dev, agp_find_caps(dev) + AGP_COMMAND, command, 4); 443 pci_write_config(mdev, agp_find_caps(mdev) + AGP_COMMAND, command, 4); 444 445 return 0; 446} 447 448int 449agp_generic_enable(device_t dev, u_int32_t mode) 450{ 451 device_t mdev = agp_find_display(); 452 u_int32_t tstatus, mstatus; 453 454 if (!mdev) { 455 AGP_DPF("can't find display\n"); 456 return ENXIO; 457 } 458 459 tstatus = pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 460 mstatus = pci_read_config(mdev, agp_find_caps(mdev) + AGP_STATUS, 4); 461 462 /* 463 * Check display and bridge for AGP v3 support. AGP v3 allows 464 * more variety in topology than v2, e.g. multiple AGP devices 465 * attached to one bridge, or multiple AGP bridges in one 466 * system. This doesn't attempt to address those situations, 467 * but should work fine for a classic single AGP slot system 468 * with AGP v3. 469 */ 470 if (AGP_MODE_GET_MODE_3(mode) && 471 AGP_MODE_GET_MODE_3(tstatus) && 472 AGP_MODE_GET_MODE_3(mstatus)) 473 return (agp_v3_enable(dev, mdev, mode)); 474 else 475 return (agp_v2_enable(dev, mdev, mode)); 476} 477 478struct agp_memory * 479agp_generic_alloc_memory(device_t dev, int type, vm_size_t size) 480{ 481 struct agp_softc *sc = device_get_softc(dev); 482 struct agp_memory *mem; 483 484 if ((size & (AGP_PAGE_SIZE - 1)) != 0) 485 return 0; 486 487 if (sc->as_allocated + size > sc->as_maxmem) 488 return 0; 489 490 if (type != 0) { 491 printf("agp_generic_alloc_memory: unsupported type %d\n", 492 type); 493 return 0; 494 } 495 496 mem = malloc(sizeof *mem, M_AGP, M_WAITOK); 497 mem->am_id = sc->as_nextid++; 498 mem->am_size = size; 499 mem->am_type = 0; 500 mem->am_obj = vm_object_allocate(OBJT_DEFAULT, atop(round_page(size))); 501 mem->am_physical = 0; 502 mem->am_offset = 0; 503 mem->am_is_bound = 0; 504 TAILQ_INSERT_TAIL(&sc->as_memory, mem, am_link); 505 sc->as_allocated += size; 506 507 return mem; 508} 509 510int 511agp_generic_free_memory(device_t dev, struct agp_memory *mem) 512{ 513 struct agp_softc *sc = device_get_softc(dev); 514 515 if (mem->am_is_bound) 516 return EBUSY; 517 518 sc->as_allocated -= mem->am_size; 519 TAILQ_REMOVE(&sc->as_memory, mem, am_link); 520 vm_object_deallocate(mem->am_obj); 521 free(mem, M_AGP); 522 return 0; 523} 524 525int 526agp_generic_bind_memory(device_t dev, struct agp_memory *mem, 527 vm_offset_t offset) 528{ 529 struct agp_softc *sc = device_get_softc(dev); 530 vm_offset_t i, j, k; 531 vm_page_t m; 532 int error; 533 534 /* Do some sanity checks first. */ 535 if (offset < 0 || (offset & (AGP_PAGE_SIZE - 1)) != 0 || 536 offset + mem->am_size > AGP_GET_APERTURE(dev)) { 537 device_printf(dev, "binding memory at bad offset %#x\n", 538 (int)offset); 539 return EINVAL; 540 } 541 542 /* 543 * Allocate the pages early, before acquiring the lock, 544 * because vm_page_grab() used with VM_ALLOC_RETRY may 545 * block and we can't hold a mutex while blocking. 546 */ 547 VM_OBJECT_LOCK(mem->am_obj); 548 for (i = 0; i < mem->am_size; i += PAGE_SIZE) { 549 /* 550 * Find a page from the object and wire it 551 * down. This page will be mapped using one or more 552 * entries in the GATT (assuming that PAGE_SIZE >= 553 * AGP_PAGE_SIZE. If this is the first call to bind, 554 * the pages will be allocated and zeroed. 555 */ 556 m = vm_page_grab(mem->am_obj, OFF_TO_IDX(i), 557 VM_ALLOC_WIRED | VM_ALLOC_ZERO | VM_ALLOC_RETRY);
|
590 error = AGP_BIND_PAGE(dev, offset + i + j, pa); 591 if (error) { 592 /* 593 * Bail out. Reverse all the mappings 594 * and unwire the pages. 595 */ 596 for (k = 0; k < i + j; k += AGP_PAGE_SIZE) 597 AGP_UNBIND_PAGE(dev, offset + k); 598 goto bad; 599 } 600 } 601 vm_page_wakeup(m); 602 } 603 VM_OBJECT_UNLOCK(mem->am_obj); 604 605 /* 606 * Flush the cpu cache since we are providing a new mapping 607 * for these pages. 608 */ 609 agp_flush_cache(); 610 611 /* 612 * Make sure the chipset gets the new mappings. 613 */ 614 AGP_FLUSH_TLB(dev); 615 616 mem->am_offset = offset; 617 mem->am_is_bound = 1; 618 619 mtx_unlock(&sc->as_lock); 620 621 return 0; 622bad: 623 mtx_unlock(&sc->as_lock); 624 VM_OBJECT_LOCK_ASSERT(mem->am_obj, MA_OWNED); 625 for (k = 0; k < mem->am_size; k += PAGE_SIZE) { 626 m = vm_page_lookup(mem->am_obj, OFF_TO_IDX(k)); 627 if (k >= i) 628 vm_page_wakeup(m); 629 vm_page_lock_queues(); 630 vm_page_unwire(m, 0); 631 vm_page_unlock_queues(); 632 } 633 VM_OBJECT_UNLOCK(mem->am_obj); 634 635 return error; 636} 637 638int 639agp_generic_unbind_memory(device_t dev, struct agp_memory *mem) 640{ 641 struct agp_softc *sc = device_get_softc(dev); 642 vm_page_t m; 643 int i; 644 645 mtx_lock(&sc->as_lock); 646 647 if (!mem->am_is_bound) { 648 device_printf(dev, "memory is not bound\n"); 649 mtx_unlock(&sc->as_lock); 650 return EINVAL; 651 } 652 653 654 /* 655 * Unbind the individual pages and flush the chipset's 656 * TLB. Unwire the pages so they can be swapped. 657 */ 658 for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE) 659 AGP_UNBIND_PAGE(dev, mem->am_offset + i); 660 VM_OBJECT_LOCK(mem->am_obj); 661 for (i = 0; i < mem->am_size; i += PAGE_SIZE) { 662 m = vm_page_lookup(mem->am_obj, atop(i)); 663 vm_page_lock_queues(); 664 vm_page_unwire(m, 0); 665 vm_page_unlock_queues(); 666 } 667 VM_OBJECT_UNLOCK(mem->am_obj); 668 669 agp_flush_cache(); 670 AGP_FLUSH_TLB(dev); 671 672 mem->am_offset = 0; 673 mem->am_is_bound = 0; 674 675 mtx_unlock(&sc->as_lock); 676 677 return 0; 678} 679 680/* Helper functions for implementing user/kernel api */ 681 682static int 683agp_acquire_helper(device_t dev, enum agp_acquire_state state) 684{ 685 struct agp_softc *sc = device_get_softc(dev); 686 687 if (sc->as_state != AGP_ACQUIRE_FREE) 688 return EBUSY; 689 sc->as_state = state; 690 691 return 0; 692} 693 694static int 695agp_release_helper(device_t dev, enum agp_acquire_state state) 696{ 697 struct agp_softc *sc = device_get_softc(dev); 698 699 if (sc->as_state == AGP_ACQUIRE_FREE) 700 return 0; 701 702 if (sc->as_state != state) 703 return EBUSY; 704 705 sc->as_state = AGP_ACQUIRE_FREE; 706 return 0; 707} 708 709static struct agp_memory * 710agp_find_memory(device_t dev, int id) 711{ 712 struct agp_softc *sc = device_get_softc(dev); 713 struct agp_memory *mem; 714 715 AGP_DPF("searching for memory block %d\n", id); 716 TAILQ_FOREACH(mem, &sc->as_memory, am_link) { 717 AGP_DPF("considering memory block %d\n", mem->am_id); 718 if (mem->am_id == id) 719 return mem; 720 } 721 return 0; 722} 723 724/* Implementation of the userland ioctl api */ 725 726static int 727agp_info_user(device_t dev, agp_info *info) 728{ 729 struct agp_softc *sc = device_get_softc(dev); 730 731 bzero(info, sizeof *info); 732 info->bridge_id = pci_get_devid(dev); 733 info->agp_mode = 734 pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 735 info->aper_base = rman_get_start(sc->as_aperture); 736 info->aper_size = AGP_GET_APERTURE(dev) >> 20; 737 info->pg_total = info->pg_system = sc->as_maxmem >> AGP_PAGE_SHIFT; 738 info->pg_used = sc->as_allocated >> AGP_PAGE_SHIFT; 739 740 return 0; 741} 742 743static int 744agp_setup_user(device_t dev, agp_setup *setup) 745{ 746 return AGP_ENABLE(dev, setup->agp_mode); 747} 748 749static int 750agp_allocate_user(device_t dev, agp_allocate *alloc) 751{ 752 struct agp_memory *mem; 753 754 mem = AGP_ALLOC_MEMORY(dev, 755 alloc->type, 756 alloc->pg_count << AGP_PAGE_SHIFT); 757 if (mem) { 758 alloc->key = mem->am_id; 759 alloc->physical = mem->am_physical; 760 return 0; 761 } else { 762 return ENOMEM; 763 } 764} 765 766static int 767agp_deallocate_user(device_t dev, int id) 768{ 769 struct agp_memory *mem = agp_find_memory(dev, id);; 770 771 if (mem) { 772 AGP_FREE_MEMORY(dev, mem); 773 return 0; 774 } else { 775 return ENOENT; 776 } 777} 778 779static int 780agp_bind_user(device_t dev, agp_bind *bind) 781{ 782 struct agp_memory *mem = agp_find_memory(dev, bind->key); 783 784 if (!mem) 785 return ENOENT; 786 787 return AGP_BIND_MEMORY(dev, mem, bind->pg_start << AGP_PAGE_SHIFT); 788} 789 790static int 791agp_unbind_user(device_t dev, agp_unbind *unbind) 792{ 793 struct agp_memory *mem = agp_find_memory(dev, unbind->key); 794 795 if (!mem) 796 return ENOENT; 797 798 return AGP_UNBIND_MEMORY(dev, mem); 799} 800 801static int 802agp_open(struct cdev *kdev, int oflags, int devtype, struct thread *td) 803{ 804 device_t dev = KDEV2DEV(kdev); 805 struct agp_softc *sc = device_get_softc(dev); 806 807 if (!sc->as_isopen) { 808 sc->as_isopen = 1; 809 device_busy(dev); 810 } 811 812 return 0; 813} 814 815static int 816agp_close(struct cdev *kdev, int fflag, int devtype, struct thread *td) 817{ 818 device_t dev = KDEV2DEV(kdev); 819 struct agp_softc *sc = device_get_softc(dev); 820 struct agp_memory *mem; 821 822 /* 823 * Clear the GATT and force release on last close 824 */ 825 while ((mem = TAILQ_FIRST(&sc->as_memory)) != 0) { 826 if (mem->am_is_bound) 827 AGP_UNBIND_MEMORY(dev, mem); 828 AGP_FREE_MEMORY(dev, mem); 829 } 830 if (sc->as_state == AGP_ACQUIRE_USER) 831 agp_release_helper(dev, AGP_ACQUIRE_USER); 832 sc->as_isopen = 0; 833 device_unbusy(dev); 834 835 return 0; 836} 837 838static int 839agp_ioctl(struct cdev *kdev, u_long cmd, caddr_t data, int fflag, struct thread *td) 840{ 841 device_t dev = KDEV2DEV(kdev); 842 843 switch (cmd) { 844 case AGPIOC_INFO: 845 return agp_info_user(dev, (agp_info *) data); 846 847 case AGPIOC_ACQUIRE: 848 return agp_acquire_helper(dev, AGP_ACQUIRE_USER); 849 850 case AGPIOC_RELEASE: 851 return agp_release_helper(dev, AGP_ACQUIRE_USER); 852 853 case AGPIOC_SETUP: 854 return agp_setup_user(dev, (agp_setup *)data); 855 856 case AGPIOC_ALLOCATE: 857 return agp_allocate_user(dev, (agp_allocate *)data); 858 859 case AGPIOC_DEALLOCATE: 860 return agp_deallocate_user(dev, *(int *) data); 861 862 case AGPIOC_BIND: 863 return agp_bind_user(dev, (agp_bind *)data); 864 865 case AGPIOC_UNBIND: 866 return agp_unbind_user(dev, (agp_unbind *)data); 867 868 } 869 870 return EINVAL; 871} 872 873static int 874agp_mmap(struct cdev *kdev, vm_offset_t offset, vm_paddr_t *paddr, int prot) 875{ 876 device_t dev = KDEV2DEV(kdev); 877 struct agp_softc *sc = device_get_softc(dev); 878 879 if (offset > AGP_GET_APERTURE(dev)) 880 return -1; 881 *paddr = rman_get_start(sc->as_aperture) + offset; 882 return 0; 883} 884 885/* Implementation of the kernel api */ 886 887device_t 888agp_find_device() 889{ 890 device_t *children, child; 891 int i, count; 892 893 if (!agp_devclass) 894 return NULL; 895 if (devclass_get_devices(agp_devclass, &children, &count) != 0) 896 return NULL; 897 child = NULL; 898 for (i = 0; i < count; i++) { 899 if (device_is_attached(children[i])) { 900 child = children[i]; 901 break; 902 } 903 } 904 free(children, M_TEMP); 905 return child; 906} 907 908enum agp_acquire_state 909agp_state(device_t dev) 910{ 911 struct agp_softc *sc = device_get_softc(dev); 912 return sc->as_state; 913} 914 915void 916agp_get_info(device_t dev, struct agp_info *info) 917{ 918 struct agp_softc *sc = device_get_softc(dev); 919 920 info->ai_mode = 921 pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 922 info->ai_aperture_base = rman_get_start(sc->as_aperture); 923 info->ai_aperture_size = rman_get_size(sc->as_aperture); 924 info->ai_memory_allowed = sc->as_maxmem; 925 info->ai_memory_used = sc->as_allocated; 926} 927 928int 929agp_acquire(device_t dev) 930{ 931 return agp_acquire_helper(dev, AGP_ACQUIRE_KERNEL); 932} 933 934int 935agp_release(device_t dev) 936{ 937 return agp_release_helper(dev, AGP_ACQUIRE_KERNEL); 938} 939 940int 941agp_enable(device_t dev, u_int32_t mode) 942{ 943 return AGP_ENABLE(dev, mode); 944} 945 946void *agp_alloc_memory(device_t dev, int type, vm_size_t bytes) 947{ 948 return (void *) AGP_ALLOC_MEMORY(dev, type, bytes); 949} 950 951void agp_free_memory(device_t dev, void *handle) 952{ 953 struct agp_memory *mem = (struct agp_memory *) handle; 954 AGP_FREE_MEMORY(dev, mem); 955} 956 957int agp_bind_memory(device_t dev, void *handle, vm_offset_t offset) 958{ 959 struct agp_memory *mem = (struct agp_memory *) handle; 960 return AGP_BIND_MEMORY(dev, mem, offset); 961} 962 963int agp_unbind_memory(device_t dev, void *handle) 964{ 965 struct agp_memory *mem = (struct agp_memory *) handle; 966 return AGP_UNBIND_MEMORY(dev, mem); 967} 968 969void agp_memory_info(device_t dev, void *handle, struct 970 agp_memory_info *mi) 971{ 972 struct agp_memory *mem = (struct agp_memory *) handle; 973 974 mi->ami_size = mem->am_size; 975 mi->ami_physical = mem->am_physical; 976 mi->ami_offset = mem->am_offset; 977 mi->ami_is_bound = mem->am_is_bound; 978}
| 591 error = AGP_BIND_PAGE(dev, offset + i + j, pa); 592 if (error) { 593 /* 594 * Bail out. Reverse all the mappings 595 * and unwire the pages. 596 */ 597 for (k = 0; k < i + j; k += AGP_PAGE_SIZE) 598 AGP_UNBIND_PAGE(dev, offset + k); 599 goto bad; 600 } 601 } 602 vm_page_wakeup(m); 603 } 604 VM_OBJECT_UNLOCK(mem->am_obj); 605 606 /* 607 * Flush the cpu cache since we are providing a new mapping 608 * for these pages. 609 */ 610 agp_flush_cache(); 611 612 /* 613 * Make sure the chipset gets the new mappings. 614 */ 615 AGP_FLUSH_TLB(dev); 616 617 mem->am_offset = offset; 618 mem->am_is_bound = 1; 619 620 mtx_unlock(&sc->as_lock); 621 622 return 0; 623bad: 624 mtx_unlock(&sc->as_lock); 625 VM_OBJECT_LOCK_ASSERT(mem->am_obj, MA_OWNED); 626 for (k = 0; k < mem->am_size; k += PAGE_SIZE) { 627 m = vm_page_lookup(mem->am_obj, OFF_TO_IDX(k)); 628 if (k >= i) 629 vm_page_wakeup(m); 630 vm_page_lock_queues(); 631 vm_page_unwire(m, 0); 632 vm_page_unlock_queues(); 633 } 634 VM_OBJECT_UNLOCK(mem->am_obj); 635 636 return error; 637} 638 639int 640agp_generic_unbind_memory(device_t dev, struct agp_memory *mem) 641{ 642 struct agp_softc *sc = device_get_softc(dev); 643 vm_page_t m; 644 int i; 645 646 mtx_lock(&sc->as_lock); 647 648 if (!mem->am_is_bound) { 649 device_printf(dev, "memory is not bound\n"); 650 mtx_unlock(&sc->as_lock); 651 return EINVAL; 652 } 653 654 655 /* 656 * Unbind the individual pages and flush the chipset's 657 * TLB. Unwire the pages so they can be swapped. 658 */ 659 for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE) 660 AGP_UNBIND_PAGE(dev, mem->am_offset + i); 661 VM_OBJECT_LOCK(mem->am_obj); 662 for (i = 0; i < mem->am_size; i += PAGE_SIZE) { 663 m = vm_page_lookup(mem->am_obj, atop(i)); 664 vm_page_lock_queues(); 665 vm_page_unwire(m, 0); 666 vm_page_unlock_queues(); 667 } 668 VM_OBJECT_UNLOCK(mem->am_obj); 669 670 agp_flush_cache(); 671 AGP_FLUSH_TLB(dev); 672 673 mem->am_offset = 0; 674 mem->am_is_bound = 0; 675 676 mtx_unlock(&sc->as_lock); 677 678 return 0; 679} 680 681/* Helper functions for implementing user/kernel api */ 682 683static int 684agp_acquire_helper(device_t dev, enum agp_acquire_state state) 685{ 686 struct agp_softc *sc = device_get_softc(dev); 687 688 if (sc->as_state != AGP_ACQUIRE_FREE) 689 return EBUSY; 690 sc->as_state = state; 691 692 return 0; 693} 694 695static int 696agp_release_helper(device_t dev, enum agp_acquire_state state) 697{ 698 struct agp_softc *sc = device_get_softc(dev); 699 700 if (sc->as_state == AGP_ACQUIRE_FREE) 701 return 0; 702 703 if (sc->as_state != state) 704 return EBUSY; 705 706 sc->as_state = AGP_ACQUIRE_FREE; 707 return 0; 708} 709 710static struct agp_memory * 711agp_find_memory(device_t dev, int id) 712{ 713 struct agp_softc *sc = device_get_softc(dev); 714 struct agp_memory *mem; 715 716 AGP_DPF("searching for memory block %d\n", id); 717 TAILQ_FOREACH(mem, &sc->as_memory, am_link) { 718 AGP_DPF("considering memory block %d\n", mem->am_id); 719 if (mem->am_id == id) 720 return mem; 721 } 722 return 0; 723} 724 725/* Implementation of the userland ioctl api */ 726 727static int 728agp_info_user(device_t dev, agp_info *info) 729{ 730 struct agp_softc *sc = device_get_softc(dev); 731 732 bzero(info, sizeof *info); 733 info->bridge_id = pci_get_devid(dev); 734 info->agp_mode = 735 pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 736 info->aper_base = rman_get_start(sc->as_aperture); 737 info->aper_size = AGP_GET_APERTURE(dev) >> 20; 738 info->pg_total = info->pg_system = sc->as_maxmem >> AGP_PAGE_SHIFT; 739 info->pg_used = sc->as_allocated >> AGP_PAGE_SHIFT; 740 741 return 0; 742} 743 744static int 745agp_setup_user(device_t dev, agp_setup *setup) 746{ 747 return AGP_ENABLE(dev, setup->agp_mode); 748} 749 750static int 751agp_allocate_user(device_t dev, agp_allocate *alloc) 752{ 753 struct agp_memory *mem; 754 755 mem = AGP_ALLOC_MEMORY(dev, 756 alloc->type, 757 alloc->pg_count << AGP_PAGE_SHIFT); 758 if (mem) { 759 alloc->key = mem->am_id; 760 alloc->physical = mem->am_physical; 761 return 0; 762 } else { 763 return ENOMEM; 764 } 765} 766 767static int 768agp_deallocate_user(device_t dev, int id) 769{ 770 struct agp_memory *mem = agp_find_memory(dev, id);; 771 772 if (mem) { 773 AGP_FREE_MEMORY(dev, mem); 774 return 0; 775 } else { 776 return ENOENT; 777 } 778} 779 780static int 781agp_bind_user(device_t dev, agp_bind *bind) 782{ 783 struct agp_memory *mem = agp_find_memory(dev, bind->key); 784 785 if (!mem) 786 return ENOENT; 787 788 return AGP_BIND_MEMORY(dev, mem, bind->pg_start << AGP_PAGE_SHIFT); 789} 790 791static int 792agp_unbind_user(device_t dev, agp_unbind *unbind) 793{ 794 struct agp_memory *mem = agp_find_memory(dev, unbind->key); 795 796 if (!mem) 797 return ENOENT; 798 799 return AGP_UNBIND_MEMORY(dev, mem); 800} 801 802static int 803agp_open(struct cdev *kdev, int oflags, int devtype, struct thread *td) 804{ 805 device_t dev = KDEV2DEV(kdev); 806 struct agp_softc *sc = device_get_softc(dev); 807 808 if (!sc->as_isopen) { 809 sc->as_isopen = 1; 810 device_busy(dev); 811 } 812 813 return 0; 814} 815 816static int 817agp_close(struct cdev *kdev, int fflag, int devtype, struct thread *td) 818{ 819 device_t dev = KDEV2DEV(kdev); 820 struct agp_softc *sc = device_get_softc(dev); 821 struct agp_memory *mem; 822 823 /* 824 * Clear the GATT and force release on last close 825 */ 826 while ((mem = TAILQ_FIRST(&sc->as_memory)) != 0) { 827 if (mem->am_is_bound) 828 AGP_UNBIND_MEMORY(dev, mem); 829 AGP_FREE_MEMORY(dev, mem); 830 } 831 if (sc->as_state == AGP_ACQUIRE_USER) 832 agp_release_helper(dev, AGP_ACQUIRE_USER); 833 sc->as_isopen = 0; 834 device_unbusy(dev); 835 836 return 0; 837} 838 839static int 840agp_ioctl(struct cdev *kdev, u_long cmd, caddr_t data, int fflag, struct thread *td) 841{ 842 device_t dev = KDEV2DEV(kdev); 843 844 switch (cmd) { 845 case AGPIOC_INFO: 846 return agp_info_user(dev, (agp_info *) data); 847 848 case AGPIOC_ACQUIRE: 849 return agp_acquire_helper(dev, AGP_ACQUIRE_USER); 850 851 case AGPIOC_RELEASE: 852 return agp_release_helper(dev, AGP_ACQUIRE_USER); 853 854 case AGPIOC_SETUP: 855 return agp_setup_user(dev, (agp_setup *)data); 856 857 case AGPIOC_ALLOCATE: 858 return agp_allocate_user(dev, (agp_allocate *)data); 859 860 case AGPIOC_DEALLOCATE: 861 return agp_deallocate_user(dev, *(int *) data); 862 863 case AGPIOC_BIND: 864 return agp_bind_user(dev, (agp_bind *)data); 865 866 case AGPIOC_UNBIND: 867 return agp_unbind_user(dev, (agp_unbind *)data); 868 869 } 870 871 return EINVAL; 872} 873 874static int 875agp_mmap(struct cdev *kdev, vm_offset_t offset, vm_paddr_t *paddr, int prot) 876{ 877 device_t dev = KDEV2DEV(kdev); 878 struct agp_softc *sc = device_get_softc(dev); 879 880 if (offset > AGP_GET_APERTURE(dev)) 881 return -1; 882 *paddr = rman_get_start(sc->as_aperture) + offset; 883 return 0; 884} 885 886/* Implementation of the kernel api */ 887 888device_t 889agp_find_device() 890{ 891 device_t *children, child; 892 int i, count; 893 894 if (!agp_devclass) 895 return NULL; 896 if (devclass_get_devices(agp_devclass, &children, &count) != 0) 897 return NULL; 898 child = NULL; 899 for (i = 0; i < count; i++) { 900 if (device_is_attached(children[i])) { 901 child = children[i]; 902 break; 903 } 904 } 905 free(children, M_TEMP); 906 return child; 907} 908 909enum agp_acquire_state 910agp_state(device_t dev) 911{ 912 struct agp_softc *sc = device_get_softc(dev); 913 return sc->as_state; 914} 915 916void 917agp_get_info(device_t dev, struct agp_info *info) 918{ 919 struct agp_softc *sc = device_get_softc(dev); 920 921 info->ai_mode = 922 pci_read_config(dev, agp_find_caps(dev) + AGP_STATUS, 4); 923 info->ai_aperture_base = rman_get_start(sc->as_aperture); 924 info->ai_aperture_size = rman_get_size(sc->as_aperture); 925 info->ai_memory_allowed = sc->as_maxmem; 926 info->ai_memory_used = sc->as_allocated; 927} 928 929int 930agp_acquire(device_t dev) 931{ 932 return agp_acquire_helper(dev, AGP_ACQUIRE_KERNEL); 933} 934 935int 936agp_release(device_t dev) 937{ 938 return agp_release_helper(dev, AGP_ACQUIRE_KERNEL); 939} 940 941int 942agp_enable(device_t dev, u_int32_t mode) 943{ 944 return AGP_ENABLE(dev, mode); 945} 946 947void *agp_alloc_memory(device_t dev, int type, vm_size_t bytes) 948{ 949 return (void *) AGP_ALLOC_MEMORY(dev, type, bytes); 950} 951 952void agp_free_memory(device_t dev, void *handle) 953{ 954 struct agp_memory *mem = (struct agp_memory *) handle; 955 AGP_FREE_MEMORY(dev, mem); 956} 957 958int agp_bind_memory(device_t dev, void *handle, vm_offset_t offset) 959{ 960 struct agp_memory *mem = (struct agp_memory *) handle; 961 return AGP_BIND_MEMORY(dev, mem, offset); 962} 963 964int agp_unbind_memory(device_t dev, void *handle) 965{ 966 struct agp_memory *mem = (struct agp_memory *) handle; 967 return AGP_UNBIND_MEMORY(dev, mem); 968} 969 970void agp_memory_info(device_t dev, void *handle, struct 971 agp_memory_info *mi) 972{ 973 struct agp_memory *mem = (struct agp_memory *) handle; 974 975 mi->ami_size = mem->am_size; 976 mi->ami_physical = mem->am_physical; 977 mi->ami_offset = mem->am_offset; 978 mi->ami_is_bound = mem->am_is_bound; 979}
|