1 /*- 2 * Copyright (c) 2000-2001 by Coleman Kane <cokane@FreeBSD.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * This product includes software developed by Gardner Buchanan. 16 * 4. The name of Gardner Buchanan may not be used to endorse or promote 17 * products derived from this software without specific prior written 18 * permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 23 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <sys/cdefs.h> 33 __FBSDID("$FreeBSD$"); 34 35 /* 3dfx driver for FreeBSD 4.x - Finished 11 May 2000, 12:25AM ET 36 * 37 * Copyright (C) 2000-2001, by Coleman Kane <cokane@FreeBSD.org>, 38 * based upon the 3dfx driver written for linux, by Daryll Straus, Jon Taylor, 39 * and Jens Axboe, located at http://linux.3dfx.com. 40 */ 41 42 #include <sys/param.h> 43 44 #include <sys/bus.h> 45 #include <sys/conf.h> 46 #include <sys/fcntl.h> 47 #include <sys/file.h> 48 #include <sys/filedesc.h> 49 #include <sys/filio.h> 50 #include <sys/ioccom.h> 51 #include <sys/kernel.h> 52 #include <sys/module.h> 53 #include <sys/malloc.h> 54 #include <sys/mman.h> 55 #include <sys/signalvar.h> 56 #include <sys/systm.h> 57 #include <sys/uio.h> 58 59 #include <dev/pci/pcivar.h> 60 #include <dev/pci/pcireg.h> 61 62 #include <vm/vm.h> 63 #include <vm/vm_kern.h> 64 #include <vm/pmap.h> 65 #include <vm/vm_extern.h> 66 67 /* rman.h depends on machine/bus.h */ 68 #include <machine/resource.h> 69 #include <machine/bus.h> 70 #include <sys/rman.h> 71 72 #include <dev/tdfx/tdfx_io.h> 73 #include <dev/tdfx/tdfx_vars.h> 74 #include <dev/tdfx/tdfx_pci.h> 75 76 77 static devclass_t tdfx_devclass; 78 79 80 static int tdfx_count = 0; 81 82 83 /* Set up the boot probe/attach routines */ 84 static device_method_t tdfx_methods[] = { 85 DEVMETHOD(device_probe, tdfx_probe), 86 DEVMETHOD(device_attach, tdfx_attach), 87 DEVMETHOD(device_detach, tdfx_detach), 88 DEVMETHOD(device_shutdown, tdfx_shutdown), 89 { 0, 0 } 90 }; 91 92 static MALLOC_DEFINE(M_TDFX,"tdfx_driver","3DFX Graphics[/2D]/3D Accelerators"); 93 94 /* Char. Dev. file operations structure */ 95 static struct cdevsw tdfx_cdev = { 96 .d_version = D_VERSION, 97 .d_flags = D_NEEDGIANT, 98 .d_open = tdfx_open, 99 .d_close = tdfx_close, 100 .d_ioctl = tdfx_ioctl, 101 .d_mmap = tdfx_mmap, 102 .d_name = "tdfx", 103 }; 104 105 static int 106 tdfx_probe(device_t dev) 107 { 108 /* 109 * probe routine called on kernel boot to register supported devices. We get 110 * a device structure to work with, and we can test the VENDOR/DEVICE IDs to 111 * see if this PCI device is one that we support. Return BUS_PRROBE_DEFAULT 112 * if yes, ENXIO if not. 113 */ 114 switch(pci_get_devid(dev)) { 115 case PCI_DEVICE_ALLIANCE_AT3D: 116 device_set_desc(dev, "ProMotion At3D 3D Accelerator"); 117 return BUS_PROBE_DEFAULT; 118 case PCI_DEVICE_3DFX_VOODOO2: 119 device_set_desc(dev, "3DFX Voodoo II 3D Accelerator"); 120 return BUS_PROBE_DEFAULT; 121 /*case PCI_DEVICE_3DFX_BANSHEE: 122 device_set_desc(dev, "3DFX Voodoo Banshee 2D/3D Graphics Accelerator"); 123 return BUS_PROBE_DEFAULT; 124 case PCI_DEVICE_3DFX_VOODOO3: 125 device_set_desc(dev, "3DFX Voodoo3 2D/3D Graphics Accelerator"); 126 return BUS_PROBE_DEFAULT;*/ 127 case PCI_DEVICE_3DFX_VOODOO1: 128 device_set_desc(dev, "3DFX Voodoo Graphics 3D Accelerator"); 129 return BUS_PROBE_DEFAULT; 130 }; 131 132 return ENXIO; 133 } 134 135 static int 136 tdfx_attach(device_t dev) { 137 /* 138 * The attach routine is called after the probe routine successfully says it 139 * supports a given card. We now proceed to initialize this card for use with 140 * the system. I want to map the device memory for userland allocation and 141 * fill an information structure with information on this card. I'd also like 142 * to set Write Combining with the MTRR code so that we can hopefully speed 143 * up memory writes. The last thing is to register the character device 144 * interface to the card, so we can open it from /dev/3dfxN, where N is a 145 * small, whole number. 146 */ 147 struct tdfx_softc *tdfx_info; 148 u_long val; 149 /* rid value tells bus_alloc_resource where to find the addresses of ports or 150 * of memory ranges in the PCI config space*/ 151 int rid = PCIR_BAR(0); 152 153 /* Increment the card counter (for the ioctl code) */ 154 tdfx_count++; 155 156 /* Enable MemMap on Voodoo */ 157 val = pci_read_config(dev, PCIR_COMMAND, 2); 158 val |= (PCIM_CMD_MEMEN); 159 pci_write_config(dev, PCIR_COMMAND, val, 2); 160 val = pci_read_config(dev, PCIR_COMMAND, 2); 161 162 /* Fill the soft config struct with info about this device*/ 163 tdfx_info = device_get_softc(dev); 164 tdfx_info->dev = dev; 165 tdfx_info->vendor = pci_get_vendor(dev); 166 tdfx_info->type = pci_get_devid(dev) >> 16; 167 tdfx_info->bus = pci_get_bus(dev); 168 tdfx_info->dv = pci_get_slot(dev); 169 tdfx_info->curFile = NULL; 170 171 /* 172 * Get the Memory Location from the PCI Config, mask out lower word, since 173 * the config space register is only one word long (this is nicer than a 174 * bitshift). 175 */ 176 tdfx_info->addr0 = (pci_read_config(dev, 0x10, 4) & 0xffff0000); 177 #ifdef DEBUG 178 device_printf(dev, "Base0 @ 0x%x\n", tdfx_info->addr0); 179 #endif 180 /* Notify the VM that we will be mapping some memory later */ 181 tdfx_info->memrange = bus_alloc_resource_any(dev, SYS_RES_MEMORY, 182 &rid, RF_ACTIVE | RF_SHAREABLE); 183 if(tdfx_info->memrange == NULL) { 184 #ifdef DEBUG 185 device_printf(dev, "Error mapping mem, won't be able to use mmap()\n"); 186 #endif 187 tdfx_info->memrid = 0; 188 } 189 else { 190 tdfx_info->memrid = rid; 191 #ifdef DEBUG 192 device_printf(dev, "Mapped to: 0x%x\n", 193 (unsigned int)rman_get_start(tdfx_info->memrange)); 194 #endif 195 } 196 197 /* Setup for Voodoo3 and Banshee, PIO and an extram Memrange */ 198 if(pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3 || 199 pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE) { 200 rid = 0x14; /* 2nd mem map */ 201 tdfx_info->addr1 = (pci_read_config(dev, 0x14, 4) & 0xffff0000); 202 #ifdef DEBUG 203 device_printf(dev, "Base1 @ 0x%x\n", tdfx_info->addr1); 204 #endif 205 tdfx_info->memrange2 = bus_alloc_resource_any(dev, 206 SYS_RES_MEMORY, &rid, RF_ACTIVE | RF_SHAREABLE); 207 if(tdfx_info->memrange2 == NULL) { 208 #ifdef DEBUG 209 device_printf(dev, "Mem1 couldn't be allocated, glide may not work."); 210 #endif 211 tdfx_info->memrid2 = 0; 212 } 213 else { 214 tdfx_info->memrid2 = rid; 215 } 216 /* Now to map the PIO stuff */ 217 rid = PCIR_IOBASE0_2; 218 tdfx_info->pio0 = pci_read_config(dev, 0x2c, 2); 219 tdfx_info->pio0max = pci_read_config(dev, 0x30, 2) + tdfx_info->pio0; 220 tdfx_info->piorange = bus_alloc_resource_any(dev, 221 SYS_RES_IOPORT, &rid, RF_ACTIVE | RF_SHAREABLE); 222 if(tdfx_info->piorange == NULL) { 223 #ifdef DEBUG 224 device_printf(dev, "Couldn't map PIO range."); 225 #endif 226 tdfx_info->piorid = 0; 227 } 228 else { 229 tdfx_info->piorid = rid; 230 } 231 } else { 232 tdfx_info->addr1 = 0; 233 tdfx_info->memrange2 = NULL; 234 tdfx_info->piorange = NULL; 235 } 236 237 /* 238 * Set Writecombining, or at least Uncacheable for the memory region, if we 239 * are able to 240 */ 241 242 if(tdfx_setmtrr(dev) != 0) { 243 #ifdef DEBUG 244 device_printf(dev, "Some weird error setting MTRRs"); 245 #endif 246 return -1; 247 } 248 249 /* 250 * make_dev registers the cdev to access the 3dfx card from /dev 251 * use hex here for the dev num, simply to provide better support if > 10 252 * voodoo cards, for the mad. The user must set the link. 253 * Why would we want that many voodoo cards anyhow? 254 */ 255 tdfx_info->devt = make_dev(&tdfx_cdev, device_get_unit(dev), 256 UID_ROOT, GID_WHEEL, 0600, "3dfx%x", device_get_unit(dev)); 257 tdfx_info->devt->si_drv1 = tdfx_info; 258 259 return 0; 260 } 261 262 static int 263 tdfx_detach(device_t dev) { 264 struct tdfx_softc* tdfx_info; 265 int retval; 266 tdfx_info = device_get_softc(dev); 267 268 /* Delete allocated resource, of course */ 269 bus_release_resource(dev, SYS_RES_MEMORY, tdfx_info->memrid, 270 tdfx_info->memrange); 271 272 /* Release extended Voodoo3/Banshee resources */ 273 if(pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE || 274 pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3) { 275 if(tdfx_info->memrange2 != NULL) 276 bus_release_resource(dev, SYS_RES_MEMORY, tdfx_info->memrid2, 277 tdfx_info->memrange); 278 /* if(tdfx_info->piorange != NULL) 279 bus_release_resource(dev, SYS_RES_IOPORT, tdfx_info->piorid, 280 tdfx_info->piorange);*/ 281 } 282 283 /* Though it is safe to leave the WRCOMB support since the 284 mem driver checks for it, we should remove it in order 285 to free an MTRR for another device */ 286 retval = tdfx_clrmtrr(dev); 287 #ifdef DEBUG 288 if(retval != 0) 289 printf("tdfx: For some reason, I couldn't clear the mtrr\n"); 290 #endif 291 /* Remove device entry when it can no longer be accessed */ 292 destroy_dev(tdfx_info->devt); 293 return(0); 294 } 295 296 static int 297 tdfx_shutdown(device_t dev) { 298 #ifdef DEBUG 299 device_printf(dev, "tdfx: Device Shutdown\n"); 300 #endif 301 return 0; 302 } 303 304 static int 305 tdfx_clrmtrr(device_t dev) { 306 /* This function removes the MTRR set by the attach call, so it can be used 307 * in the future by other drivers. 308 */ 309 int retval, act; 310 struct tdfx_softc *tdfx_info = device_get_softc(dev); 311 312 act = MEMRANGE_SET_REMOVE; 313 retval = mem_range_attr_set(&tdfx_info->mrdesc, &act); 314 return retval; 315 } 316 317 static int 318 tdfx_setmtrr(device_t dev) { 319 /* 320 * This is the MTRR setting function for the 3dfx card. It is called from 321 * tdfx_attach. If we can't set the MTRR properly, it's not the end of the 322 * world. We can still continue, just with slightly (very slightly) degraded 323 * performance. 324 */ 325 int retval = 0, act; 326 struct tdfx_softc *tdfx_info = device_get_softc(dev); 327 328 /* The older Voodoo cards have a shorter memrange than the newer ones */ 329 if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO1) || (pci_get_devid(dev) == 330 PCI_DEVICE_3DFX_VOODOO2)) { 331 tdfx_info->mrdesc.mr_len = 0x400000; 332 333 /* The memory descriptor is described as the top 15 bits of the real 334 address */ 335 tdfx_info->mrdesc.mr_base = tdfx_info->addr0 & 0xfffe0000; 336 } 337 else if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3) || 338 (pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE)) { 339 tdfx_info->mrdesc.mr_len = 0x1000000; 340 /* The Voodoo3 and Banshee LFB is the second memory address */ 341 /* The memory descriptor is described as the top 15 bits of the real 342 address */ 343 tdfx_info->mrdesc.mr_base = tdfx_info->addr1 & 0xfffe0000; 344 } 345 else 346 return 0; 347 /* 348 * The Alliance Pro Motion AT3D was not mentioned in the linux 349 * driver as far as MTRR support goes, so I just won't put the 350 * code in here for it. This is where it should go, though. 351 */ 352 353 /* Firstly, try to set write combining */ 354 tdfx_info->mrdesc.mr_flags = MDF_WRITECOMBINE; 355 bcopy("tdfx", &tdfx_info->mrdesc.mr_owner, 4); 356 act = MEMRANGE_SET_UPDATE; 357 retval = mem_range_attr_set(&tdfx_info->mrdesc, &act); 358 359 if(retval == 0) { 360 #ifdef DEBUG 361 device_printf(dev, "MTRR Set Correctly for tdfx\n"); 362 #endif 363 } else if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO2) || 364 (pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO1)) { 365 /* if, for some reason we can't set the WRCOMB range with the V1/V2, we 366 * can still possibly use the UNCACHEABLE region for it instead, and help 367 * out in a small way */ 368 tdfx_info->mrdesc.mr_flags = MDF_UNCACHEABLE; 369 /* This length of 1000h was taken from the linux device driver... */ 370 tdfx_info->mrdesc.mr_len = 0x1000; 371 372 /* 373 * If, for some reason, we can't set the MTRR (N/A?) we may still continue 374 */ 375 #ifdef DEBUG 376 device_printf(dev, "MTRR Set Type Uncacheable %x\n", 377 (u_int32_t)tdfx_info->mrdesc.mr_base); 378 #endif 379 } 380 #ifdef DEBUG 381 else { 382 device_printf(dev, "Couldn't Set MTRR\n"); 383 return 0; 384 } 385 #endif 386 return 0; 387 } 388 389 static int 390 tdfx_open(struct cdev *dev, int flags, int fmt, struct thread *td) 391 { 392 /* 393 * The open cdev method handles open(2) calls to /dev/3dfx[n] 394 * We can pretty much allow any opening of the device. 395 */ 396 struct tdfx_softc *tdfx_info = dev->si_drv1; 397 if(tdfx_info->busy != 0) return EBUSY; 398 #ifdef DEBUG 399 printf("3dfx: Opened by #%d\n", td->td_proc->p_pid); 400 #endif 401 /* Set the driver as busy */ 402 tdfx_info->busy++; 403 return 0; 404 } 405 406 static int 407 tdfx_close(struct cdev *dev, int fflag, int devtype, struct thread *td) 408 { 409 /* 410 * The close cdev method handles close(2) calls to /dev/3dfx[n] 411 * We'll always want to close the device when it's called. 412 */ 413 struct tdfx_softc *tdfx_info = dev->si_drv1; 414 if(tdfx_info->busy == 0) return EBADF; 415 tdfx_info->busy = 0; 416 #ifdef DEBUG 417 printf("Closed by #%d\n", td->td_proc->p_pid); 418 #endif 419 return 0; 420 } 421 422 static int 423 tdfx_mmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr, 424 int nprot, vm_memattr_t *memattr) 425 { 426 /* 427 * mmap(2) is called by a user process to request that an area of memory 428 * associated with this device be mapped for the process to work with. Nprot 429 * holds the protections requested, PROT_READ, PROT_WRITE, or both. 430 */ 431 432 /**** OLD GET CONFIG ****/ 433 /* struct tdfx_softc* tdfx_info; */ 434 435 /* Get the configuration for our card XXX*/ 436 /*tdfx_info = dev->si_drv1; */ 437 /************************/ 438 439 struct tdfx_softc* tdfx_info[2]; 440 441 tdfx_info[0] = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 0); 442 443 /* If, for some reason, its not configured, we bail out */ 444 if(tdfx_info[0] == NULL) { 445 #ifdef DEBUG 446 printf("tdfx: tdfx_info (softc) is NULL\n"); 447 #endif 448 return -1; 449 } 450 451 /* We must stay within the bound of our address space */ 452 if((offset & 0xff000000) == tdfx_info[0]->addr0) { 453 offset &= 0xffffff; 454 *paddr = rman_get_start(tdfx_info[0]->memrange) + offset; 455 return 0; 456 } 457 458 if(tdfx_count > 1) { 459 tdfx_info[1] = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 1); 460 if((offset & 0xff000000) == tdfx_info[1]->addr0) { 461 offset &= 0xffffff; 462 *paddr = rman_get_start(tdfx_info[1]->memrange) + 463 offset; 464 return 0; 465 } 466 } 467 468 /* See if the Banshee/V3 LFB is being requested */ 469 /*if(tdfx_info->memrange2 != NULL && (offset & 0xff000000) == 470 tdfx_info->addr1) { 471 offset &= 0xffffff; 472 return atop(rman_get_start(tdfx_info[1]->memrange2) + offset); 473 }*/ /* VoodooNG code */ 474 475 /* The ret call */ 476 /* atop -> address to page 477 * rman_get_start, get the (struct resource*)->r_start member, 478 * the mapping base address. 479 */ 480 return -1; 481 } 482 483 static int 484 tdfx_query_boards(void) { 485 /* 486 * This returns the number of installed tdfx cards, we have been keeping 487 * count, look at tdfx_attach 488 */ 489 return tdfx_count; 490 } 491 492 static int 493 tdfx_query_fetch(u_int cmd, struct tdfx_pio_data *piod) 494 { 495 /* XXX Comment this later, after careful inspection and spring cleaning :) */ 496 /* Various return values 8bit-32bit */ 497 u_int8_t ret_byte; 498 u_int16_t ret_word; 499 u_int32_t ret_dword; 500 struct tdfx_softc* tdfx_info = NULL; 501 502 /* This one depend on the tdfx_* structs being properly initialized */ 503 504 /*piod->device &= 0xf;*/ 505 if((piod == NULL) ||(tdfx_count <= piod->device) || 506 (piod->device < 0)) { 507 #ifdef DEBUG 508 printf("tdfx: Bad device or internal struct in tdfx_query_fetch\n"); 509 #endif 510 return -EINVAL; 511 } 512 513 tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 514 piod->device); 515 516 if(tdfx_info == NULL) return -ENXIO; 517 518 /* We must restrict the size reads from the port, since to high or low of a 519 * size witll result in wrong data being passed, and that's bad */ 520 /* A few of these were pulled during the attach phase */ 521 switch(piod->port) { 522 case PCI_VENDOR_ID_FREEBSD: 523 if(piod->size != 2) return -EINVAL; 524 copyout(&tdfx_info->vendor, piod->value, piod->size); 525 return 0; 526 case PCI_DEVICE_ID_FREEBSD: 527 if(piod->size != 2) return -EINVAL; 528 copyout(&tdfx_info->type, piod->value, piod->size); 529 return 0; 530 case PCI_BASE_ADDRESS_0_FREEBSD: 531 if(piod->size != 4) return -EINVAL; 532 copyout(&tdfx_info->addr0, piod->value, piod->size); 533 return 0; 534 case PCI_BASE_ADDRESS_1_FREEBSD: 535 if(piod->size != 4) return -EINVAL; 536 copyout(&tdfx_info->addr1, piod->value, piod->size); 537 return 0; 538 case PCI_PRIBUS_FREEBSD: 539 if(piod->size != 1) return -EINVAL; 540 break; 541 case PCI_IOBASE_0_FREEBSD: 542 if(piod->size != 2) return -EINVAL; 543 break; 544 case PCI_IOLIMIT_0_FREEBSD: 545 if(piod->size != 2) return -EINVAL; 546 break; 547 case SST1_PCI_SPECIAL1_FREEBSD: 548 if(piod->size != 4) return -EINVAL; 549 break; 550 case PCI_REVISION_ID_FREEBSD: 551 if(piod->size != 1) return -EINVAL; 552 break; 553 case SST1_PCI_SPECIAL4_FREEBSD: 554 if(piod->size != 4) return -EINVAL; 555 break; 556 default: 557 return -EINVAL; 558 } 559 560 561 /* Read the value and return */ 562 switch(piod->size) { 563 case 1: 564 ret_byte = pci_read_config(tdfx_info[piod->device].dev, 565 piod->port, 1); 566 copyout(&ret_byte, piod->value, 1); 567 break; 568 case 2: 569 ret_word = pci_read_config(tdfx_info[piod->device].dev, 570 piod->port, 2); 571 copyout(&ret_word, piod->value, 2); 572 break; 573 case 4: 574 ret_dword = pci_read_config(tdfx_info[piod->device].dev, 575 piod->port, 4); 576 copyout(&ret_dword, piod->value, 4); 577 break; 578 default: 579 return -EINVAL; 580 } 581 return 0; 582 } 583 584 static int 585 tdfx_query_update(u_int cmd, struct tdfx_pio_data *piod) 586 { 587 /* XXX Comment this later, after careful inspection and spring cleaning :) */ 588 /* Return vals */ 589 u_int8_t ret_byte; 590 u_int16_t ret_word; 591 u_int32_t ret_dword; 592 593 /* Port vals, mask */ 594 u_int32_t retval, preval, mask; 595 struct tdfx_softc* tdfx_info = NULL; 596 597 598 if((piod == NULL) || (piod->device >= (tdfx_count & 599 0xf))) { 600 #ifdef DEBUG 601 printf("tdfx: Bad struct or device in tdfx_query_update\n"); 602 #endif 603 return -EINVAL; 604 } 605 606 tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 607 piod->device); 608 if(tdfx_info == NULL) return -ENXIO; 609 /* Code below this line in the fuction was taken from the 610 * Linux driver and converted for freebsd. */ 611 612 /* Check the size for all the ports, to make sure stuff doesn't get messed up 613 * by poorly written clients */ 614 615 switch(piod->port) { 616 case PCI_COMMAND_FREEBSD: 617 if(piod->size != 2) return -EINVAL; 618 break; 619 case SST1_PCI_SPECIAL1_FREEBSD: 620 if(piod->size != 4) return -EINVAL; 621 break; 622 case SST1_PCI_SPECIAL2_FREEBSD: 623 if(piod->size != 4) return -EINVAL; 624 break; 625 case SST1_PCI_SPECIAL3_FREEBSD: 626 if(piod->size != 4) return -EINVAL; 627 break; 628 case SST1_PCI_SPECIAL4_FREEBSD: 629 if(piod->size != 4) return -EINVAL; 630 break; 631 default: 632 return -EINVAL; 633 } 634 /* Read the current value */ 635 retval = pci_read_config(tdfx_info->dev, piod->port & ~3, 4); 636 637 /* These set up a mask to use, since apparently they wanted to write 4 bytes 638 * at once to the ports */ 639 switch (piod->size) { 640 case 1: 641 copyin(piod->value, &ret_byte, 1); 642 preval = ret_byte << (8 * (piod->port & 0x3)); 643 mask = 0xff << (8 * (piod->port & 0x3)); 644 break; 645 case 2: 646 copyin(piod->value, &ret_word, 2); 647 preval = ret_word << (8 * (piod->port & 0x3)); 648 mask = 0xffff << (8 * (piod->port & 0x3)); 649 break; 650 case 4: 651 copyin(piod->value, &ret_dword, 4); 652 preval = ret_dword; 653 mask = ~0; 654 break; 655 default: 656 return -EINVAL; 657 } 658 /* Finally, combine the values and write it to the port */ 659 retval = (retval & ~mask) | preval; 660 pci_write_config(tdfx_info->dev, piod->port & ~3, retval, 4); 661 662 return 0; 663 } 664 665 /* For both of these, I added a variable named workport of type u_int so 666 * that I could eliminate the warning about my data type size. The 667 * applications expect the port to be of type short, so I needed to change 668 * this within the function */ 669 static int 670 tdfx_do_pio_rd(struct tdfx_pio_data *piod) 671 { 672 /* Return val */ 673 u_int8_t ret_byte; 674 u_int workport; 675 struct tdfx_softc *tdfx_info = 676 (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, piod->device); 677 678 /* Restricts the access of ports other than those we use */ 679 if(((piod->port != VGA_INPUT_STATUS_1C) || (piod->port != SC_INDEX) || 680 (piod->port != SC_DATA) || (piod->port != VGA_MISC_OUTPUT_READ)) && 681 (piod->port < tdfx_info->pio0) && (piod->port > tdfx_info->pio0max)) 682 return -EPERM; 683 684 /* All VGA STATUS REGS are byte registers, size should never be > 1 */ 685 if(piod->size != 1) { 686 return -EINVAL; 687 } 688 689 /* Write the data to the intended port */ 690 workport = piod->port; 691 ret_byte = inb(workport); 692 copyout(&ret_byte, piod->value, sizeof(u_int8_t)); 693 return 0; 694 } 695 696 static int 697 tdfx_do_pio_wt(struct tdfx_pio_data *piod) 698 { 699 /* return val */ 700 u_int8_t ret_byte; 701 u_int workport; 702 struct tdfx_softc *tdfx_info = (struct 703 tdfx_softc*)devclass_get_softc(tdfx_devclass, piod->device); 704 /* Replace old switch w/ massive if(...) */ 705 /* Restricts the access of ports other than those we use */ 706 if(((piod->port != SC_INDEX) && (piod->port != SC_DATA) && 707 (piod->port != VGA_MISC_OUTPUT_READ)) /* Can't write VGA_ST_1C */ && 708 (piod->port < tdfx_info->pio0) && (piod->port > tdfx_info->pio0max)) 709 return -EPERM; 710 711 /* All VGA STATUS REGS are byte registers, size should never be > 1 */ 712 if(piod->size != 1) { 713 return -EINVAL; 714 } 715 716 /* Write the data to the intended port */ 717 copyin(piod->value, &ret_byte, sizeof(u_int8_t)); 718 workport = piod->port; 719 outb(workport, ret_byte); 720 return 0; 721 } 722 723 static int 724 tdfx_do_query(u_int cmd, struct tdfx_pio_data *piod) 725 { 726 /* There are three sub-commands to the query 0x33 */ 727 switch(_IOC_NR(cmd)) { 728 case 2: 729 return tdfx_query_boards(); 730 break; 731 case 3: 732 return tdfx_query_fetch(cmd, piod); 733 break; 734 case 4: 735 return tdfx_query_update(cmd, piod); 736 break; 737 default: 738 /* In case we are thrown a bogus sub-command! */ 739 #ifdef DEBUG 740 printf("Bad Sub-cmd: 0x%x\n", _IOC_NR(cmd)); 741 #endif 742 return -EINVAL; 743 } 744 } 745 746 static int 747 tdfx_do_pio(u_int cmd, struct tdfx_pio_data *piod) 748 { 749 /* Two types of PIO, INPUT and OUTPUT, as the name suggests */ 750 switch(_IOC_DIR(cmd)) { 751 case IOCV_OUT: 752 return tdfx_do_pio_rd(piod); 753 break; 754 case IOCV_IN: 755 return tdfx_do_pio_wt(piod); 756 break; 757 default: 758 return -EINVAL; 759 } 760 } 761 762 /* Calls to ioctl(2) eventually end up here. Unhandled ioctls return an ENXIO, 763 * normally, you would read in the data pointed to by data, then write your 764 * output to it. The ioctl *should* normally return zero if everything is 765 * alright, but 3dfx didn't make it that way... 766 * 767 * For all of the ioctl code, in the event of a real error, 768 * we return -Exxxx rather than simply Exxxx. The reason for this 769 * is that the ioctls actually RET information back to the program 770 * sometimes, rather than filling it in the passed structure. We 771 * want to distinguish errors from useful data, and maintain compatibility. 772 * 773 * There is this portion of the proc struct called p_retval[], we can store a 774 * return value in td->td_retval[0] and place the return value if it is positive 775 * in there, then we can return 0 (good). If the return value is negative, we 776 * can return -retval and the error should be properly handled. 777 */ 778 static int 779 tdfx_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td) 780 { 781 int retval = 0; 782 struct tdfx_pio_data *piod = (struct tdfx_pio_data*)data; 783 #ifdef DEBUG 784 printf("IOCTL'd by #%d, cmd: 0x%x, data: %p\n", td->td_proc->p_pid, (u_int32_t)cmd, 785 piod); 786 #endif 787 switch(_IOC_TYPE(cmd)) { 788 /* Return the real error if negative, or simply stick the valid return 789 * in td->td_retval */ 790 case 0x33: 791 /* The '3'(0x33) type IOCTL is for querying the installed cards */ 792 if((retval = tdfx_do_query(cmd, piod)) > 0) td->td_retval[0] = retval; 793 else return -retval; 794 break; 795 case 0: 796 /* The 0 type IOCTL is for programmed I/O methods */ 797 if((tdfx_do_pio(cmd, piod)) > 0) td->td_retval[0] = retval; 798 else return -retval; 799 break; 800 default: 801 /* Technically, we won't reach this from linux emu, but when glide 802 * finally gets ported, watch out! */ 803 #ifdef DEBUG 804 printf("Bad IOCTL from #%d\n", td->td_proc->p_pid); 805 #endif 806 return ENXIO; 807 } 808 809 return 0; 810 } 811 812 /* This is the device driver struct. This is sent to the driver subsystem to 813 * register the method structure and the info strcut space for this particular 814 * instance of the driver. 815 */ 816 static driver_t tdfx_driver = { 817 "tdfx", 818 tdfx_methods, 819 sizeof(struct tdfx_softc), 820 }; 821 822 /* Tell Mr. Kernel about us! */ 823 DRIVER_MODULE(tdfx, pci, tdfx_driver, tdfx_devclass, 0, 0); 824 MODULE_DEPEND(tdfx, mem, 1, 1, 1); 825 MODULE_VERSION(tdfx, 1); 826