sys/dev/tdfx/tdfx_pci.c

   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/cdefs.h>
  46 #include <sys/conf.h>
  47 #include <sys/fcntl.h>
  48 #include <sys/file.h>
  49 #include <sys/filedesc.h>
  50 #include <sys/filio.h>
  51 #include <sys/ioccom.h>
  52 #include <sys/kernel.h>
  53 #include <sys/module.h>
  54 #include <sys/malloc.h>
  55 #include <sys/mman.h>
  56 #include <sys/signalvar.h>
  57 #include <sys/systm.h>
  58 #include <sys/uio.h>
  59
  60 #include <dev/pci/pcivar.h>
  61 #include <dev/pci/pcireg.h>
  62
  63 #include <vm/vm.h>
  64 #include <vm/vm_kern.h>
  65 #include <vm/pmap.h>
  66 #include <vm/vm_extern.h>
  67
  68 /* rman.h depends on machine/bus.h */
  69 #include <machine/resource.h>
  70 #include <machine/bus.h>
  71 #include <sys/rman.h>
  72
  73 #include <dev/tdfx/tdfx_io.h>
  74 #include <dev/tdfx/tdfx_vars.h>
  75 #include <dev/tdfx/tdfx_pci.h>
  76
  77
  78 static devclass_t tdfx_devclass;
  79
  80
  81 static int tdfx_count = 0;
  82
  83
  84 /* Set up the boot probe/attach routines */
  85 static device_method_t tdfx_methods[] = {
  86         DEVMETHOD(device_probe,         tdfx_probe),
  87         DEVMETHOD(device_attach,        tdfx_attach),
  88         DEVMETHOD(device_detach,        tdfx_detach),
  89         DEVMETHOD(device_shutdown,      tdfx_shutdown),
  90         { 0, 0 }
  91 };
  92
  93 MALLOC_DEFINE(M_TDFX,"tdfx_driver","3DFX Graphics[/2D]/3D Accelerator(s)");
  94
  95 /* Char. Dev. file operations structure */
  96 static struct cdevsw tdfx_cdev = {
  97         .d_version =    D_VERSION,
  98         .d_flags =      D_NEEDGIANT,
  99         .d_open =       tdfx_open,
 100         .d_close =      tdfx_close,
 101         .d_ioctl =      tdfx_ioctl,
 102         .d_mmap =       tdfx_mmap,
 103         .d_name =       "tdfx",
 104 };
 105
 106 static int
 107 tdfx_probe(device_t dev)
 108 {
 109         /*
 110          * probe routine called on kernel boot to register supported devices. We get
 111          * a device structure to work with, and we can test the VENDOR/DEVICE IDs to
 112          * see if this PCI device is one that we support. Return BUS_PRROBE_DEFAULT
 113          * if yes, ENXIO if not.
 114          */
 115         switch(pci_get_devid(dev)) {
 116         case PCI_DEVICE_ALLIANCE_AT3D:
 117                 device_set_desc(dev, "ProMotion At3D 3D Accelerator");
 118                 return BUS_PROBE_DEFAULT;
 119         case PCI_DEVICE_3DFX_VOODOO2:
 120                 device_set_desc(dev, "3DFX Voodoo II 3D Accelerator");
 121                 return BUS_PROBE_DEFAULT;
 122         /*case PCI_DEVICE_3DFX_BANSHEE:
 123                 device_set_desc(dev, "3DFX Voodoo Banshee 2D/3D Graphics Accelerator");
 124                 return BUS_PROBE_DEFAULT;
 125         case PCI_DEVICE_3DFX_VOODOO3:
 126                 device_set_desc(dev, "3DFX Voodoo3 2D/3D Graphics Accelerator");
 127                 return BUS_PROBE_DEFAULT;*/
 128         case PCI_DEVICE_3DFX_VOODOO1:
 129                 device_set_desc(dev, "3DFX Voodoo Graphics 3D Accelerator");
 130                 return BUS_PROBE_DEFAULT;
 131         };
 132
 133         return ENXIO;
 134 }
 135
 136 static int
 137 tdfx_attach(device_t dev) {
 138         /*
 139          * The attach routine is called after the probe routine successfully says it
 140          * supports a given card. We now proceed to initialize this card for use with
 141          * the system. I want to map the device memory for userland allocation and
 142          * fill an information structure with information on this card. I'd also like
 143          * to set Write Combining with the MTRR code so that we can hopefully speed
 144          * up memory writes. The last thing is to register the character device
 145          * interface to the card, so we can open it from /dev/3dfxN, where N is a
 146          * small, whole number.
 147          */
 148         struct tdfx_softc *tdfx_info;
 149         u_long  val;
 150         /* rid value tells bus_alloc_resource where to find the addresses of ports or
 151          * of memory ranges in the PCI config space*/
 152         int rid = PCIR_BAR(0);
 153
 154         /* Increment the card counter (for the ioctl code) */
 155         tdfx_count++;
 156
 157         /* Enable MemMap on Voodoo */
 158         val = pci_read_config(dev, PCIR_COMMAND, 2);
 159         val |= (PCIM_CMD_MEMEN);
 160         pci_write_config(dev, PCIR_COMMAND, val, 2);
 161         val = pci_read_config(dev, PCIR_COMMAND, 2);
 162
 163         /* Fill the soft config struct with info about this device*/
 164         tdfx_info = device_get_softc(dev);
 165         tdfx_info->dev = dev;
 166         tdfx_info->vendor = pci_get_vendor(dev);
 167         tdfx_info->type = pci_get_devid(dev) >> 16;
 168         tdfx_info->bus = pci_get_bus(dev);
 169         tdfx_info->dv = pci_get_slot(dev);
 170         tdfx_info->curFile = NULL;
 171
 172         /*
 173          *      Get the Memory Location from the PCI Config, mask out lower word, since
 174          * the config space register is only one word long (this is nicer than a
 175          * bitshift).
 176          */
 177         tdfx_info->addr0 = (pci_read_config(dev, 0x10, 4) & 0xffff0000);
 178 #ifdef DEBUG
 179         device_printf(dev, "Base0 @ 0x%x\n", tdfx_info->addr0);
 180 #endif
 181         /* Notify the VM that we will be mapping some memory later */
 182         tdfx_info->memrange = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
 183                 &rid, RF_ACTIVE | RF_SHAREABLE);
 184         if(tdfx_info->memrange == NULL) {
 185 #ifdef DEBUG
 186                 device_printf(dev, "Error mapping mem, won't be able to use mmap()\n");
 187 #endif
 188                 tdfx_info->memrid = 0;
 189         }
 190         else {
 191                 tdfx_info->memrid = rid;
 192 #ifdef DEBUG
 193                 device_printf(dev, "Mapped to: 0x%x\n",
 194                                 (unsigned int)rman_get_start(tdfx_info->memrange));
 195 #endif
 196         }
 197
 198         /* Setup for Voodoo3 and Banshee, PIO and an extram Memrange */
 199         if(pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3 ||
 200                 pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE) {
 201                 rid = 0x14;     /* 2nd mem map */
 202                 tdfx_info->addr1 = (pci_read_config(dev, 0x14, 4) & 0xffff0000);
 203 #ifdef DEBUG
 204                 device_printf(dev, "Base1 @ 0x%x\n", tdfx_info->addr1);
 205 #endif
 206                 tdfx_info->memrange2 = bus_alloc_resource_any(dev,
 207                         SYS_RES_MEMORY, &rid, RF_ACTIVE | RF_SHAREABLE);
 208                 if(tdfx_info->memrange2 == NULL) {
 209 #ifdef DEBUG
 210                         device_printf(dev, "Mem1 couldn't be allocated, glide may not work.");
 211 #endif
 212                         tdfx_info->memrid2 = 0;
 213                 }
 214                 else {
 215                         tdfx_info->memrid2 = rid;
 216                 }
 217                 /* Now to map the PIO stuff */
 218                 rid = PCIR_IOBASE0_2;
 219                 tdfx_info->pio0 = pci_read_config(dev, 0x2c, 2);
 220                 tdfx_info->pio0max = pci_read_config(dev, 0x30, 2) + tdfx_info->pio0;
 221                 tdfx_info->piorange = bus_alloc_resource_any(dev,
 222                         SYS_RES_IOPORT, &rid, RF_ACTIVE | RF_SHAREABLE);
 223                 if(tdfx_info->piorange == NULL) {
 224 #ifdef DEBUG
 225                         device_printf(dev, "Couldn't map PIO range.");
 226 #endif
 227                         tdfx_info->piorid = 0;
 228                 }
 229                 else {
 230                         tdfx_info->piorid = rid;
 231                 }
 232         } else {
 233           tdfx_info->addr1 = 0;
 234           tdfx_info->memrange2 = NULL;
 235           tdfx_info->piorange = NULL;
 236         }
 237
 238         /*
 239          *      Set Writecombining, or at least Uncacheable for the memory region, if we
 240          * are able to
 241          */
 242
 243         if(tdfx_setmtrr(dev) != 0) {
 244 #ifdef DEBUG
 245                 device_printf(dev, "Some weird error setting MTRRs");
 246 #endif
 247                 return -1;
 248         }
 249
 250         /*
 251          * make_dev registers the cdev to access the 3dfx card from /dev
 252          *      use hex here for the dev num, simply to provide better support if > 10
 253          * voodoo cards, for the mad. The user must set the link, or use MAKEDEV.
 254          * Why would we want that many voodoo cards anyhow?
 255          */
 256         tdfx_info->devt = make_dev(&tdfx_cdev, device_get_unit(dev),
 257                 UID_ROOT, GID_WHEEL, 0600, "3dfx%x", device_get_unit(dev));
 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 = devclass_get_softc(tdfx_devclass,
 397                         UNIT(minor(dev)));
 398         if(tdfx_info->busy != 0) return EBUSY;
 399 #ifdef  DEBUG
 400         printf("3dfx: Opened by #%d\n", td->td_proc->p_pid);
 401 #endif
 402         /* Set the driver as busy */
 403         tdfx_info->busy++;
 404         return 0;
 405 }
 406
 407 static int
 408 tdfx_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
 409 {
 410         /*
 411          *      The close cdev method handles close(2) calls to /dev/3dfx[n]
 412          * We'll always want to close the device when it's called.
 413          */
 414         struct tdfx_softc *tdfx_info = devclass_get_softc(tdfx_devclass,
 415                 UNIT(minor(dev)));
 416         if(tdfx_info->busy == 0) return EBADF;
 417         tdfx_info->busy = 0;
 418 #ifdef  DEBUG
 419         printf("Closed by #%d\n", td->td_proc->p_pid);
 420 #endif
 421         return 0;
 422 }
 423
 424 static int
 425 tdfx_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int nprot)
 426 {
 427         /*
 428          * mmap(2) is called by a user process to request that an area of memory
 429          * associated with this device be mapped for the process to work with. Nprot
 430          * holds the protections requested, PROT_READ, PROT_WRITE, or both.
 431          */
 432
 433         /**** OLD GET CONFIG ****/
 434         /* struct tdfx_softc* tdfx_info; */
 435
 436         /* Get the configuration for our card XXX*/
 437         /*tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass,
 438                         UNIT(minor(dev)));*/
 439         /************************/
 440
 441         struct tdfx_softc* tdfx_info[2];
 442
 443         tdfx_info[0] = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 0);
 444
 445         /* If, for some reason, its not configured, we bail out */
 446         if(tdfx_info[0] == NULL) {
 447 #ifdef  DEBUG
 448            printf("tdfx: tdfx_info (softc) is NULL\n");
 449 #endif
 450            return -1;
 451         }
 452
 453         /* We must stay within the bound of our address space */
 454         if((offset & 0xff000000) == tdfx_info[0]->addr0) {
 455                 offset &= 0xffffff;
 456                 *paddr = rman_get_start(tdfx_info[0]->memrange) + offset;
 457                 return 0;
 458         }
 459
 460         if(tdfx_count > 1) {
 461                 tdfx_info[1] = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 1);
 462                 if((offset & 0xff000000) == tdfx_info[1]->addr0) {
 463                         offset &= 0xffffff;
 464                         *paddr = rman_get_start(tdfx_info[1]->memrange) +
 465                             offset;
 466                         return 0;
 467                 }
 468         }
 469
 470         /* See if the Banshee/V3 LFB is being requested */
 471         /*if(tdfx_info->memrange2 != NULL && (offset & 0xff000000) ==
 472                         tdfx_info->addr1) {
 473                 offset &= 0xffffff;
 474                 return atop(rman_get_start(tdfx_info[1]->memrange2) + offset);
 475         }*/ /* VoodooNG code */
 476
 477         /* The ret call */
 478         /* atop -> address to page
 479          * rman_get_start, get the (struct resource*)->r_start member,
 480          * the mapping base address.
 481          */
 482         return -1;
 483 }
 484
 485 static int
 486 tdfx_query_boards(void) {
 487         /*
 488     *   This returns the number of installed tdfx cards, we have been keeping
 489          * count, look at tdfx_attach
 490          */
 491         return tdfx_count;
 492 }
 493
 494 static int
 495 tdfx_query_fetch(u_int cmd, struct tdfx_pio_data *piod)
 496 {
 497         /* XXX Comment this later, after careful inspection and spring cleaning :) */
 498         /* Various return values 8bit-32bit */
 499         u_int8_t  ret_byte;
 500         u_int16_t ret_word;
 501         u_int32_t ret_dword;
 502         struct tdfx_softc* tdfx_info = NULL;
 503
 504         /* This one depend on the tdfx_* structs being properly initialized */
 505
 506         /*piod->device &= 0xf;*/
 507         if((piod == NULL) ||(tdfx_count <= piod->device) ||
 508                         (piod->device < 0)) {
 509 #ifdef DEBUG
 510                 printf("tdfx: Bad device or internal struct in tdfx_query_fetch\n");
 511 #endif
 512                 return -EINVAL;
 513         }
 514
 515         tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass,
 516                         piod->device);
 517
 518         if(tdfx_info == NULL) return -ENXIO;
 519
 520         /* We must restrict the size reads from the port, since to high or low of a
 521          * size witll result in wrong data being passed, and that's bad */
 522         /* A few of these were pulled during the attach phase */
 523         switch(piod->port) {
 524                 case PCI_VENDOR_ID_FREEBSD:
 525                         if(piod->size != 2) return -EINVAL;
 526                         copyout(&tdfx_info->vendor, piod->value, piod->size);
 527                         return 0;
 528                 case PCI_DEVICE_ID_FREEBSD:
 529                         if(piod->size != 2) return -EINVAL;
 530                         copyout(&tdfx_info->type, piod->value, piod->size);
 531                         return 0;
 532                 case PCI_BASE_ADDRESS_0_FREEBSD:
 533                         if(piod->size != 4) return -EINVAL;
 534                         copyout(&tdfx_info->addr0, piod->value, piod->size);
 535                         return 0;
 536                 case PCI_BASE_ADDRESS_1_FREEBSD:
 537                         if(piod->size != 4) return -EINVAL;
 538                         copyout(&tdfx_info->addr1, piod->value, piod->size);
 539                         return 0;
 540                 case PCI_PRIBUS_FREEBSD:
 541                         if(piod->size != 1) return -EINVAL;
 542                         break;
 543                 case PCI_IOBASE_0_FREEBSD:
 544                         if(piod->size != 2) return -EINVAL;
 545                         break;
 546                 case PCI_IOLIMIT_0_FREEBSD:
 547                         if(piod->size != 2) return -EINVAL;
 548                         break;
 549                 case SST1_PCI_SPECIAL1_FREEBSD:
 550                         if(piod->size != 4) return -EINVAL;
 551                         break;
 552                 case PCI_REVISION_ID_FREEBSD:
 553                         if(piod->size != 1) return -EINVAL;
 554                         break;
 555                 case SST1_PCI_SPECIAL4_FREEBSD:
 556                         if(piod->size != 4) return -EINVAL;
 557                         break;
 558                 default:
 559                         return -EINVAL;
 560         }
 561
 562
 563         /* Read the value and return */
 564         switch(piod->size) {
 565                 case 1:
 566                         ret_byte = pci_read_config(tdfx_info[piod->device].dev,
 567                                         piod->port, 1);
 568                         copyout(&ret_byte, piod->value, 1);
 569                         break;
 570                 case 2:
 571                         ret_word = pci_read_config(tdfx_info[piod->device].dev,
 572                                         piod->port, 2);
 573                         copyout(&ret_word, piod->value, 2);
 574                         break;
 575                 case 4:
 576                         ret_dword = pci_read_config(tdfx_info[piod->device].dev,
 577                                         piod->port, 4);
 578                         copyout(&ret_dword, piod->value, 4);
 579                         break;
 580                 default:
 581                         return -EINVAL;
 582         }
 583         return 0;
 584 }
 585
 586 static int
 587 tdfx_query_update(u_int cmd, struct tdfx_pio_data *piod)
 588 {
 589         /* XXX Comment this later, after careful inspection and spring cleaning :) */
 590         /* Return vals */
 591         u_int8_t  ret_byte;
 592         u_int16_t ret_word;
 593         u_int32_t ret_dword;
 594
 595         /* Port vals, mask */
 596         u_int32_t retval, preval, mask;
 597         struct tdfx_softc* tdfx_info = NULL;
 598
 599
 600         if((piod == NULL) || (piod->device >= (tdfx_count &
 601                                         0xf))) {
 602 #ifdef DEBUG
 603                 printf("tdfx: Bad struct or device in tdfx_query_update\n");
 604 #endif
 605                 return -EINVAL;
 606         }
 607
 608         tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass,
 609                         piod->device);
 610         if(tdfx_info == NULL) return -ENXIO;
 611         /* Code below this line in the fuction was taken from the
 612          * Linux driver and converted for freebsd. */
 613
 614         /* Check the size for all the ports, to make sure stuff doesn't get messed up
 615          * by poorly written clients */
 616
 617         switch(piod->port) {
 618                 case PCI_COMMAND_FREEBSD:
 619                         if(piod->size != 2) return -EINVAL;
 620                         break;
 621                 case SST1_PCI_SPECIAL1_FREEBSD:
 622                         if(piod->size != 4) return -EINVAL;
 623                         break;
 624                 case SST1_PCI_SPECIAL2_FREEBSD:
 625                         if(piod->size != 4) return -EINVAL;
 626                         break;
 627                 case SST1_PCI_SPECIAL3_FREEBSD:
 628                         if(piod->size != 4) return -EINVAL;
 629                         break;
 630                 case SST1_PCI_SPECIAL4_FREEBSD:
 631                         if(piod->size != 4) return -EINVAL;
 632                         break;
 633                 default:
 634                         return -EINVAL;
 635         }
 636         /* Read the current value */
 637         retval = pci_read_config(tdfx_info->dev, piod->port & ~3, 4);
 638
 639         /* These set up a mask to use, since apparently they wanted to write 4 bytes
 640          * at once to the ports */
 641         switch (piod->size) {
 642                 case 1:
 643                         copyin(piod->value, &ret_byte, 1);
 644                         preval = ret_byte << (8 * (piod->port & 0x3));
 645                         mask = 0xff << (8 * (piod->port & 0x3));
 646                         break;
 647                 case 2:
 648                         copyin(piod->value, &ret_word, 2);
 649                         preval = ret_word << (8 * (piod->port & 0x3));
 650                         mask = 0xffff << (8 * (piod->port & 0x3));
 651                         break;
 652                 case 4:
 653                         copyin(piod->value, &ret_dword, 4);
 654                         preval = ret_dword;
 655                         mask = ~0;
 656                         break;
 657                 default:
 658                         return -EINVAL;
 659         }
 660         /* Finally, combine the values and write it to the port */
 661         retval = (retval & ~mask) | preval;
 662         pci_write_config(tdfx_info->dev, piod->port & ~3, retval, 4);
 663
 664         return 0;
 665 }
 666
 667 /* For both of these, I added a variable named workport of type u_int so
 668  * that I could eliminate the warning about my data type size. The
 669  * applications expect the port to be of type short, so I needed to change
 670  * this within the function */
 671 static int
 672 tdfx_do_pio_rd(struct tdfx_pio_data *piod)
 673 {
 674         /* Return val */
 675         u_int8_t  ret_byte;
 676         u_int    workport;
 677         struct tdfx_softc *tdfx_info =
 678                 (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, piod->device);
 679
 680         /* Restricts the access of ports other than those we use */
 681         if(((piod->port != VGA_INPUT_STATUS_1C) || (piod->port != SC_INDEX) ||
 682                 (piod->port != SC_DATA) || (piod->port != VGA_MISC_OUTPUT_READ)) &&
 683                 (piod->port < tdfx_info->pio0) && (piod->port > tdfx_info->pio0max))
 684                 return -EPERM;
 685
 686         /* All VGA STATUS REGS are byte registers, size should never be > 1 */
 687         if(piod->size != 1) {
 688                 return -EINVAL;
 689         }
 690
 691         /* Write the data to the intended port */
 692         workport = piod->port;
 693         ret_byte = inb(workport);
 694         copyout(&ret_byte, piod->value, sizeof(u_int8_t));
 695         return 0;
 696 }
 697
 698 static int
 699 tdfx_do_pio_wt(struct tdfx_pio_data *piod)
 700 {
 701         /* return val */
 702         u_int8_t  ret_byte;
 703         u_int            workport;
 704         struct tdfx_softc *tdfx_info = (struct
 705                         tdfx_softc*)devclass_get_softc(tdfx_devclass, piod->device);
 706         /* Replace old switch w/ massive if(...) */
 707         /* Restricts the access of ports other than those we use */
 708         if(((piod->port != SC_INDEX) && (piod->port != SC_DATA) &&
 709                 (piod->port != VGA_MISC_OUTPUT_READ)) /* Can't write VGA_ST_1C */ &&
 710                 (piod->port < tdfx_info->pio0) && (piod->port > tdfx_info->pio0max))
 711                 return -EPERM;
 712
 713         /* All VGA STATUS REGS are byte registers, size should never be > 1 */
 714         if(piod->size != 1) {
 715                 return -EINVAL;
 716         }
 717
 718         /* Write the data to the intended port */
 719         copyin(piod->value, &ret_byte, sizeof(u_int8_t));
 720         workport = piod->port;
 721         outb(workport, ret_byte);
 722         return 0;
 723 }
 724
 725 static int
 726 tdfx_do_query(u_int cmd, struct tdfx_pio_data *piod)
 727 {
 728         /* There are three sub-commands to the query 0x33 */
 729         switch(_IOC_NR(cmd)) {
 730                 case 2:
 731                         return tdfx_query_boards();
 732                         break;
 733                 case 3:
 734                         return tdfx_query_fetch(cmd, piod);
 735                         break;
 736                 case 4:
 737                         return tdfx_query_update(cmd, piod);
 738                         break;
 739                 default:
 740                         /* In case we are thrown a bogus sub-command! */
 741 #ifdef DEBUG
 742                         printf("Bad Sub-cmd: 0x%x\n", _IOC_NR(cmd));
 743 #endif
 744                         return -EINVAL;
 745         }
 746 }
 747
 748 static int
 749 tdfx_do_pio(u_int cmd, struct tdfx_pio_data *piod)
 750 {
 751         /* Two types of PIO, INPUT and OUTPUT, as the name suggests */
 752         switch(_IOC_DIR(cmd)) {
 753                 case IOCV_OUT:
 754                         return tdfx_do_pio_rd(piod);
 755                         break;
 756                 case IOCV_IN:
 757                         return tdfx_do_pio_wt(piod);
 758                         break;
 759                 default:
 760                         return -EINVAL;
 761         }
 762 }
 763
 764 /* Calls to ioctl(2) eventually end up here. Unhandled ioctls return an ENXIO,
 765  * normally, you would read in the data pointed to by data, then write your
 766  * output to it. The ioctl *should* normally return zero if everything is
 767  * alright, but 3dfx didn't make it that way...
 768  *
 769  * For all of the ioctl code, in the event of a real error,
 770  * we return -Exxxx rather than simply Exxxx. The reason for this
 771  * is that the ioctls actually RET information back to the program
 772  * sometimes, rather than filling it in the passed structure. We
 773  * want to distinguish errors from useful data, and maintain compatibility.
 774  *
 775  * There is this portion of the proc struct called p_retval[], we can store a
 776  * return value in td->td_retval[0] and place the return value if it is positive
 777  * in there, then we can return 0 (good). If the return value is negative, we
 778  * can return -retval and the error should be properly handled.
 779  */
 780 static int
 781 tdfx_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td)
 782 {
 783         int retval = 0;
 784         struct tdfx_pio_data *piod = (struct tdfx_pio_data*)data;
 785 #ifdef  DEBUG
 786         printf("IOCTL'd by #%d, cmd: 0x%x, data: %p\n", td->td_proc->p_pid, (u_int32_t)cmd,
 787                         piod);
 788 #endif
 789         switch(_IOC_TYPE(cmd)) {
 790                 /* Return the real error if negative, or simply stick the valid return
 791                  * in td->td_retval */
 792         case 0x33:
 793                         /* The '3'(0x33) type IOCTL is for querying the installed cards */
 794                         if((retval = tdfx_do_query(cmd, piod)) > 0) td->td_retval[0] = retval;
 795                         else return -retval;
 796                         break;
 797                 case 0:
 798                         /* The 0 type IOCTL is for programmed I/O methods */
 799                         if((tdfx_do_pio(cmd, piod)) > 0) td->td_retval[0] = retval;
 800                         else return -retval;
 801                         break;
 802                 default:
 803                         /* Technically, we won't reach this from linux emu, but when glide
 804                          * finally gets ported, watch out! */
 805 #ifdef DEBUG
 806                         printf("Bad IOCTL from #%d\n", td->td_proc->p_pid);
 807 #endif
 808                         return ENXIO;
 809         }
 810
 811         return 0;
 812 }
 813
 814 /* This is the device driver struct. This is sent to the driver subsystem to
 815  * register the method structure and the info strcut space for this particular
 816  * instance of the driver.
 817  */
 818 static driver_t tdfx_driver = {
 819         "tdfx",
 820         tdfx_methods,
 821         sizeof(struct tdfx_softc),
 822 };
 823
 824 /* Tell Mr. Kernel about us! */
 825 DRIVER_MODULE(tdfx, pci, tdfx_driver, tdfx_devclass, 0, 0);
 826 MODULE_DEPEND(tdfx, mem, 1, 1, 1);
 827 MODULE_VERSION(tdfx, 1);