agp_amd64.c revision 187100
119304Speter/*- 219304Speter * Copyright (c) 2004, 2005 Jung-uk Kim <jkim@FreeBSD.org> 319304Speter * All rights reserved. 419304Speter * 519304Speter * Redistribution and use in source and binary forms, with or without 619304Speter * modification, are permitted provided that the following conditions 719304Speter * are met: 819304Speter * 1. Redistributions of source code must retain the above copyright 919304Speter * notice, this list of conditions and the following disclaimer. 1019304Speter * 2. Redistributions in binary form must reproduce the above copyright 1119304Speter * notice, this list of conditions and the following disclaimer in the 1219304Speter * documentation and/or other materials provided with the distribution. 13254225Speter * 1419304Speter * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1519304Speter * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1619304Speter * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1719304Speter * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1819304Speter * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1919304Speter * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2019304Speter * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2119304Speter * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2219304Speter * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2319304Speter * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2419304Speter * SUCH DAMAGE. 2519304Speter */ 2619304Speter 2719304Speter#include <sys/cdefs.h> 2819304Speter__FBSDID("$FreeBSD: head/sys/dev/agp/agp_amd64.c 187100 2009-01-12 16:07:03Z jkim $"); 2919304Speter 3019304Speter#include "opt_bus.h" 3119304Speter 3219304Speter#include <sys/param.h> 3319304Speter#include <sys/systm.h> 3419304Speter#include <sys/malloc.h> 3519304Speter#include <sys/kernel.h> 3619304Speter#include <sys/module.h> 3719304Speter#include <sys/bus.h> 3819304Speter#include <sys/lock.h> 3919304Speter#include <sys/mutex.h> 4019304Speter#include <sys/proc.h> 4119304Speter 4219304Speter#include <dev/agp/agppriv.h> 4319304Speter#include <dev/agp/agpreg.h> 4419304Speter#include <dev/pci/pcivar.h> 4519304Speter#include <dev/pci/pcireg.h> 4619304Speter 4719304Speter#include <vm/vm.h> 4819304Speter#include <vm/vm_object.h> 4919304Speter#include <vm/pmap.h> 50254225Speter#include <machine/bus.h> 5119304Speter#include <machine/resource.h> 5219304Speter#include <sys/rman.h> 5319304Speter 5419304Speter/* XXX */ 55254225Speterextern void pci_cfgregwrite(int, int, int, int, uint32_t, int); 5619304Speterextern uint32_t pci_cfgregread(int, int, int, int, int); 5719304Speter 5819304Speterstatic void agp_amd64_apbase_fixup(device_t); 5919304Speter 6019304Speterstatic void agp_amd64_uli_init(device_t); 6119304Speterstatic int agp_amd64_uli_set_aperture(device_t, uint32_t); 6219304Speter 6319304Speterstatic int agp_amd64_nvidia_match(uint16_t); 6419304Speterstatic void agp_amd64_nvidia_init(device_t); 6519304Speterstatic int agp_amd64_nvidia_set_aperture(device_t, uint32_t); 6619304Speter 6719304Speterstatic int agp_amd64_via_match(void); 6819304Speterstatic void agp_amd64_via_init(device_t); 6919304Speterstatic int agp_amd64_via_set_aperture(device_t, uint32_t); 7019304Speter 7119304SpeterMALLOC_DECLARE(M_AGP); 7219304Speter 7319304Speter#define AMD64_MAX_MCTRL 8 7419304Speter 7519304Speterstruct agp_amd64_softc { 7619304Speter struct agp_softc agp; 7719304Speter uint32_t initial_aperture; 7819304Speter struct agp_gatt *gatt; 7919304Speter uint32_t apbase; 8019304Speter int mctrl[AMD64_MAX_MCTRL]; 8119304Speter int n_mctrl; 8219304Speter int via_agp; 8319304Speter}; 8419304Speter 8519304Speterstatic const char* 8619304Speteragp_amd64_match(device_t dev) 8719304Speter{ 8819304Speter if (pci_get_class(dev) != PCIC_BRIDGE || 8919304Speter pci_get_subclass(dev) != PCIS_BRIDGE_HOST || 9019304Speter agp_find_caps(dev) == 0) 9119304Speter return (NULL); 9219304Speter 9319304Speter switch (pci_get_devid(dev)) { 9419304Speter case 0x74541022: 9519304Speter return ("AMD 8151 AGP graphics tunnel"); 9619304Speter case 0x07551039: 9719304Speter return ("SiS 755 host to AGP bridge"); 9819304Speter case 0x07601039: 9919304Speter return ("SiS 760 host to AGP bridge"); 10019304Speter case 0x168910b9: 10119304Speter return ("ULi M1689 AGP Controller"); 10219304Speter case 0x00d110de: 10319304Speter if (agp_amd64_nvidia_match(0x00d2)) 10419304Speter return (NULL); 10519304Speter return ("NVIDIA nForce3 AGP Controller"); 10619304Speter case 0x00e110de: 10719304Speter if (agp_amd64_nvidia_match(0x00e2)) 108254225Speter return (NULL); 10919304Speter return ("NVIDIA nForce3-250 AGP Controller"); 11019304Speter case 0x02041106: 11119304Speter return ("VIA 8380 host to PCI bridge"); 11219304Speter case 0x02381106: 11319304Speter return ("VIA 3238 host to PCI bridge"); 11419304Speter case 0x02821106: 11519304Speter return ("VIA K8T800Pro host to PCI bridge"); 11619304Speter case 0x31881106: 11719304Speter return ("VIA 8385 host to PCI bridge"); 11819304Speter }; 11919304Speter 12019304Speter return (NULL); 12119304Speter} 12219304Speter 12319304Speterstatic int 12419304Speteragp_amd64_nvidia_match(uint16_t devid) 12519304Speter{ 12619304Speter /* XXX nForce3 requires secondary AGP bridge at 0:11:0. */ 12719304Speter if (pci_cfgregread(0, 11, 0, PCIR_CLASS, 1) != PCIC_BRIDGE || 12819304Speter pci_cfgregread(0, 11, 0, PCIR_SUBCLASS, 1) != PCIS_BRIDGE_PCI || 12919304Speter pci_cfgregread(0, 11, 0, PCIR_VENDOR, 2) != 0x10de || 13019304Speter pci_cfgregread(0, 11, 0, PCIR_DEVICE, 2) != devid) 13119304Speter return (ENXIO); 13219304Speter 13319304Speter return (0); 13419304Speter} 13519304Speter 13619304Speterstatic int 13719304Speteragp_amd64_via_match(void) 13819304Speter{ 13919304Speter /* XXX Some VIA bridge requires secondary AGP bridge at 0:1:0. */ 14019304Speter if (pci_cfgregread(0, 1, 0, PCIR_CLASS, 1) != PCIC_BRIDGE || 14119304Speter pci_cfgregread(0, 1, 0, PCIR_SUBCLASS, 1) != PCIS_BRIDGE_PCI || 14219304Speter pci_cfgregread(0, 1, 0, PCIR_VENDOR, 2) != 0x1106 || 14319304Speter pci_cfgregread(0, 1, 0, PCIR_DEVICE, 2) != 0xb188 || 144254225Speter (pci_cfgregread(0, 1, 0, AGP_VIA_AGPSEL, 1) & 2)) 14519304Speter return (0); 14619304Speter 14719304Speter return (1); 148254225Speter} 149254225Speter 15019304Speterstatic int 151254225Speteragp_amd64_probe(device_t dev) 152254225Speter{ 15319304Speter const char *desc; 15419304Speter 15519304Speter if (resource_disabled("agp", device_get_unit(dev))) 156254225Speter return (ENXIO); 157254225Speter if ((desc = agp_amd64_match(dev))) { 158254225Speter device_set_desc(dev, desc); 15919304Speter return (BUS_PROBE_DEFAULT); 160254225Speter } 161254225Speter 16219304Speter return (ENXIO); 16319304Speter} 16419304Speter 16519304Speterstatic int 16619304Speteragp_amd64_attach(device_t dev) 16719304Speter{ 16819304Speter struct agp_amd64_softc *sc = device_get_softc(dev); 169254225Speter struct agp_gatt *gatt; 17019304Speter uint32_t devid; 17119304Speter int i, n, error; 172 173 for (i = 0, n = 0; i < PCI_SLOTMAX && n < AMD64_MAX_MCTRL; i++) { 174 devid = pci_cfgregread(0, i, 3, 0, 4); 175 if (devid == 0x11031022 || devid == 0x12031022) { 176 sc->mctrl[n] = i; 177 n++; 178 } 179 } 180 if (n == 0) 181 return (ENXIO); 182 183 sc->n_mctrl = n; 184 185 if (bootverbose) 186 device_printf(dev, "%d Miscellaneous Control unit(s) found.\n", 187 sc->n_mctrl); 188 189 if ((error = agp_generic_attach(dev))) 190 return (error); 191 192 sc->initial_aperture = AGP_GET_APERTURE(dev); 193 194 for (;;) { 195 gatt = agp_alloc_gatt(dev); 196 if (gatt) 197 break; 198 199 /* 200 * Probably contigmalloc failure. Try reducing the 201 * aperture so that the gatt size reduces. 202 */ 203 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) { 204 agp_generic_detach(dev); 205 return (ENOMEM); 206 } 207 } 208 sc->gatt = gatt; 209 210 switch (pci_get_vendor(dev)) { 211 case 0x10b9: /* ULi */ 212 agp_amd64_uli_init(dev); 213 if (agp_amd64_uli_set_aperture(dev, sc->initial_aperture)) 214 return (ENXIO); 215 break; 216 217 case 0x10de: /* nVidia */ 218 agp_amd64_nvidia_init(dev); 219 if (agp_amd64_nvidia_set_aperture(dev, sc->initial_aperture)) 220 return (ENXIO); 221 break; 222 223 case 0x1106: /* VIA */ 224 sc->via_agp = agp_amd64_via_match(); 225 if (sc->via_agp) { 226 agp_amd64_via_init(dev); 227 if (agp_amd64_via_set_aperture(dev, 228 sc->initial_aperture)) 229 return (ENXIO); 230 } 231 break; 232 } 233 234 /* Install the gatt and enable aperture. */ 235 for (i = 0; i < sc->n_mctrl; i++) { 236 pci_cfgregwrite(0, sc->mctrl[i], 3, AGP_AMD64_ATTBASE, 237 (uint32_t)(gatt->ag_physical >> 8) & AGP_AMD64_ATTBASE_MASK, 238 4); 239 pci_cfgregwrite(0, sc->mctrl[i], 3, AGP_AMD64_APCTRL, 240 (pci_cfgregread(0, sc->mctrl[i], 3, AGP_AMD64_APCTRL, 4) | 241 AGP_AMD64_APCTRL_GARTEN) & 242 ~(AGP_AMD64_APCTRL_DISGARTCPU | AGP_AMD64_APCTRL_DISGARTIO), 243 4); 244 } 245 246 agp_flush_cache(); 247 248 return (0); 249} 250 251static int 252agp_amd64_detach(device_t dev) 253{ 254 struct agp_amd64_softc *sc = device_get_softc(dev); 255 int i; 256 257 agp_free_cdev(dev); 258 259 for (i = 0; i < sc->n_mctrl; i++) 260 pci_cfgregwrite(0, sc->mctrl[i], 3, AGP_AMD64_APCTRL, 261 pci_cfgregread(0, sc->mctrl[i], 3, AGP_AMD64_APCTRL, 4) & 262 ~AGP_AMD64_APCTRL_GARTEN, 4); 263 264 AGP_SET_APERTURE(dev, sc->initial_aperture); 265 agp_free_gatt(sc->gatt); 266 agp_free_res(dev); 267 268 return (0); 269} 270 271static uint32_t agp_amd64_table[] = { 272 0x02000000, /* 32 MB */ 273 0x04000000, /* 64 MB */ 274 0x08000000, /* 128 MB */ 275 0x10000000, /* 256 MB */ 276 0x20000000, /* 512 MB */ 277 0x40000000, /* 1024 MB */ 278 0x80000000, /* 2048 MB */ 279}; 280 281#define AGP_AMD64_TABLE_SIZE \ 282 (sizeof(agp_amd64_table) / sizeof(agp_amd64_table[0])) 283 284static uint32_t 285agp_amd64_get_aperture(device_t dev) 286{ 287 struct agp_amd64_softc *sc = device_get_softc(dev); 288 uint32_t i; 289 290 i = (pci_cfgregread(0, sc->mctrl[0], 3, AGP_AMD64_APCTRL, 4) & 291 AGP_AMD64_APCTRL_SIZE_MASK) >> 1; 292 293 if (i >= AGP_AMD64_TABLE_SIZE) 294 return (0); 295 296 return (agp_amd64_table[i]); 297} 298 299static int 300agp_amd64_set_aperture(device_t dev, uint32_t aperture) 301{ 302 struct agp_amd64_softc *sc = device_get_softc(dev); 303 uint32_t i; 304 int j; 305 306 for (i = 0; i < AGP_AMD64_TABLE_SIZE; i++) 307 if (agp_amd64_table[i] == aperture) 308 break; 309 if (i >= AGP_AMD64_TABLE_SIZE) 310 return (EINVAL); 311 312 for (j = 0; j < sc->n_mctrl; j++) 313 pci_cfgregwrite(0, sc->mctrl[j], 3, AGP_AMD64_APCTRL, 314 (pci_cfgregread(0, sc->mctrl[j], 3, AGP_AMD64_APCTRL, 4) & 315 ~(AGP_AMD64_APCTRL_SIZE_MASK)) | (i << 1), 4); 316 317 switch (pci_get_vendor(dev)) { 318 case 0x10b9: /* ULi */ 319 return (agp_amd64_uli_set_aperture(dev, aperture)); 320 break; 321 322 case 0x10de: /* nVidia */ 323 return (agp_amd64_nvidia_set_aperture(dev, aperture)); 324 break; 325 326 case 0x1106: /* VIA */ 327 if (sc->via_agp) 328 return (agp_amd64_via_set_aperture(dev, aperture)); 329 break; 330 } 331 332 return (0); 333} 334 335static int 336agp_amd64_bind_page(device_t dev, int offset, vm_offset_t physical) 337{ 338 struct agp_amd64_softc *sc = device_get_softc(dev); 339 340 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) 341 return (EINVAL); 342 343 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 344 (physical & 0xfffff000) | ((physical >> 28) & 0x00000ff0) | 3; 345 346 return (0); 347} 348 349static int 350agp_amd64_unbind_page(device_t dev, int offset) 351{ 352 struct agp_amd64_softc *sc = device_get_softc(dev); 353 354 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) 355 return (EINVAL); 356 357 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0; 358 359 return (0); 360} 361 362static void 363agp_amd64_flush_tlb(device_t dev) 364{ 365 struct agp_amd64_softc *sc = device_get_softc(dev); 366 int i; 367 368 for (i = 0; i < sc->n_mctrl; i++) 369 pci_cfgregwrite(0, sc->mctrl[i], 3, AGP_AMD64_CACHECTRL, 370 pci_cfgregread(0, sc->mctrl[i], 3, AGP_AMD64_CACHECTRL, 4) | 371 AGP_AMD64_CACHECTRL_INVGART, 4); 372} 373 374static void 375agp_amd64_apbase_fixup(device_t dev) 376{ 377 struct agp_amd64_softc *sc = device_get_softc(dev); 378 uint32_t apbase; 379 int i; 380 381 sc->apbase = rman_get_start(sc->agp.as_aperture); 382 apbase = (sc->apbase >> 25) & AGP_AMD64_APBASE_MASK; 383 for (i = 0; i < sc->n_mctrl; i++) 384 pci_cfgregwrite(0, sc->mctrl[i], 3, 385 AGP_AMD64_APBASE, apbase, 4); 386} 387 388static void 389agp_amd64_uli_init(device_t dev) 390{ 391 struct agp_amd64_softc *sc = device_get_softc(dev); 392 393 agp_amd64_apbase_fixup(dev); 394 pci_write_config(dev, AGP_AMD64_ULI_APBASE, 395 (pci_read_config(dev, AGP_AMD64_ULI_APBASE, 4) & 0x0000000f) | 396 sc->apbase, 4); 397 pci_write_config(dev, AGP_AMD64_ULI_HTT_FEATURE, sc->apbase, 4); 398} 399 400static int 401agp_amd64_uli_set_aperture(device_t dev, uint32_t aperture) 402{ 403 struct agp_amd64_softc *sc = device_get_softc(dev); 404 405 switch (aperture) { 406 case 0x02000000: /* 32 MB */ 407 case 0x04000000: /* 64 MB */ 408 case 0x08000000: /* 128 MB */ 409 case 0x10000000: /* 256 MB */ 410 break; 411 default: 412 return (EINVAL); 413 } 414 415 pci_write_config(dev, AGP_AMD64_ULI_ENU_SCR, 416 sc->apbase + aperture - 1, 4); 417 418 return (0); 419} 420 421static void 422agp_amd64_nvidia_init(device_t dev) 423{ 424 struct agp_amd64_softc *sc = device_get_softc(dev); 425 426 agp_amd64_apbase_fixup(dev); 427 pci_write_config(dev, AGP_AMD64_NVIDIA_0_APBASE, 428 (pci_read_config(dev, AGP_AMD64_NVIDIA_0_APBASE, 4) & 0x0000000f) | 429 sc->apbase, 4); 430 pci_cfgregwrite(0, 11, 0, AGP_AMD64_NVIDIA_1_APBASE1, sc->apbase, 4); 431 pci_cfgregwrite(0, 11, 0, AGP_AMD64_NVIDIA_1_APBASE2, sc->apbase, 4); 432} 433 434static int 435agp_amd64_nvidia_set_aperture(device_t dev, uint32_t aperture) 436{ 437 struct agp_amd64_softc *sc = device_get_softc(dev); 438 uint32_t apsize; 439 440 switch (aperture) { 441 case 0x02000000: apsize = 0x0f; break; /* 32 MB */ 442 case 0x04000000: apsize = 0x0e; break; /* 64 MB */ 443 case 0x08000000: apsize = 0x0c; break; /* 128 MB */ 444 case 0x10000000: apsize = 0x08; break; /* 256 MB */ 445 case 0x20000000: apsize = 0x00; break; /* 512 MB */ 446 default: 447 return (EINVAL); 448 } 449 450 pci_cfgregwrite(0, 11, 0, AGP_AMD64_NVIDIA_1_APSIZE, 451 (pci_cfgregread(0, 11, 0, AGP_AMD64_NVIDIA_1_APSIZE, 4) & 452 0xfffffff0) | apsize, 4); 453 pci_cfgregwrite(0, 11, 0, AGP_AMD64_NVIDIA_1_APLIMIT1, 454 sc->apbase + aperture - 1, 4); 455 pci_cfgregwrite(0, 11, 0, AGP_AMD64_NVIDIA_1_APLIMIT2, 456 sc->apbase + aperture - 1, 4); 457 458 return (0); 459} 460 461static void 462agp_amd64_via_init(device_t dev) 463{ 464 struct agp_amd64_softc *sc = device_get_softc(dev); 465 466 agp_amd64_apbase_fixup(dev); 467 pci_cfgregwrite(0, 1, 0, AGP3_VIA_ATTBASE, sc->gatt->ag_physical, 4); 468 pci_cfgregwrite(0, 1, 0, AGP3_VIA_GARTCTRL, 469 pci_cfgregread(0, 1, 0, AGP3_VIA_ATTBASE, 4) | 0x180, 4); 470} 471 472static int 473agp_amd64_via_set_aperture(device_t dev, uint32_t aperture) 474{ 475 uint32_t apsize; 476 477 apsize = ((aperture - 1) >> 20) ^ 0xff; 478 if ((((apsize ^ 0xff) << 20) | ((1 << 20) - 1)) + 1 != aperture) 479 return (EINVAL); 480 pci_cfgregwrite(0, 1, 0, AGP3_VIA_APSIZE, apsize, 1); 481 482 return (0); 483} 484 485static device_method_t agp_amd64_methods[] = { 486 /* Device interface */ 487 DEVMETHOD(device_probe, agp_amd64_probe), 488 DEVMETHOD(device_attach, agp_amd64_attach), 489 DEVMETHOD(device_detach, agp_amd64_detach), 490 DEVMETHOD(device_shutdown, bus_generic_shutdown), 491 DEVMETHOD(device_suspend, bus_generic_suspend), 492 DEVMETHOD(device_resume, bus_generic_resume), 493 494 /* AGP interface */ 495 DEVMETHOD(agp_get_aperture, agp_amd64_get_aperture), 496 DEVMETHOD(agp_set_aperture, agp_amd64_set_aperture), 497 DEVMETHOD(agp_bind_page, agp_amd64_bind_page), 498 DEVMETHOD(agp_unbind_page, agp_amd64_unbind_page), 499 DEVMETHOD(agp_flush_tlb, agp_amd64_flush_tlb), 500 DEVMETHOD(agp_enable, agp_generic_enable), 501 DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory), 502 DEVMETHOD(agp_free_memory, agp_generic_free_memory), 503 DEVMETHOD(agp_bind_memory, agp_generic_bind_memory), 504 DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory), 505 506 { 0, 0 } 507}; 508 509static driver_t agp_amd64_driver = { 510 "agp", 511 agp_amd64_methods, 512 sizeof(struct agp_amd64_softc), 513}; 514 515static devclass_t agp_devclass; 516 517DRIVER_MODULE(agp_amd64, hostb, agp_amd64_driver, agp_devclass, 0, 0); 518MODULE_DEPEND(agp_amd64, agp, 1, 1, 1); 519MODULE_DEPEND(agp_amd64, pci, 1, 1, 1); 520