The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/tdfx/tdfx_pci.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    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.
  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         tdfx_info->devt->si_drv1 = tdfx_info;
  259         
  260         return 0;
  261 }
  262 
  263 static int
  264 tdfx_detach(device_t dev) {
  265         struct tdfx_softc* tdfx_info;
  266         int retval;
  267         tdfx_info = device_get_softc(dev);
  268         
  269         /* Delete allocated resource, of course */
  270         bus_release_resource(dev, SYS_RES_MEMORY, tdfx_info->memrid,
  271                         tdfx_info->memrange);
  272 
  273         /* Release extended Voodoo3/Banshee resources */
  274         if(pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE || 
  275                         pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3) {
  276                 if(tdfx_info->memrange2 != NULL)
  277                         bus_release_resource(dev, SYS_RES_MEMORY, tdfx_info->memrid2,
  278                                 tdfx_info->memrange);
  279         /*      if(tdfx_info->piorange != NULL)
  280                         bus_release_resource(dev, SYS_RES_IOPORT, tdfx_info->piorid,
  281                                 tdfx_info->piorange);*/
  282         }               
  283 
  284         /* Though it is safe to leave the WRCOMB support since the 
  285                 mem driver checks for it, we should remove it in order
  286                 to free an MTRR for another device */
  287         retval = tdfx_clrmtrr(dev);
  288 #ifdef DEBUG
  289         if(retval != 0) 
  290                 printf("tdfx: For some reason, I couldn't clear the mtrr\n");
  291 #endif
  292         /* Remove device entry when it can no longer be accessed */
  293    destroy_dev(tdfx_info->devt);
  294         return(0);
  295 }
  296 
  297 static int
  298 tdfx_shutdown(device_t dev) {
  299 #ifdef DEBUG
  300         device_printf(dev, "tdfx: Device Shutdown\n");
  301 #endif
  302         return 0;
  303 }
  304 
  305 static int
  306 tdfx_clrmtrr(device_t dev) {
  307         /* This function removes the MTRR set by the attach call, so it can be used
  308          * in the future by other drivers. 
  309          */
  310         int retval, act;
  311         struct tdfx_softc *tdfx_info = device_get_softc(dev);
  312         
  313         act = MEMRANGE_SET_REMOVE;
  314         retval = mem_range_attr_set(&tdfx_info->mrdesc, &act);
  315         return retval;
  316 }
  317         
  318 static int
  319 tdfx_setmtrr(device_t dev) {
  320         /*
  321          * This is the MTRR setting function for the 3dfx card. It is called from
  322          * tdfx_attach. If we can't set the MTRR properly, it's not the end of the
  323          * world. We can still continue, just with slightly (very slightly) degraded
  324          * performance.
  325          */
  326         int retval = 0, act;
  327         struct tdfx_softc *tdfx_info = device_get_softc(dev);
  328 
  329         /* The older Voodoo cards have a shorter memrange than the newer ones */
  330         if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO1) || (pci_get_devid(dev) ==
  331                         PCI_DEVICE_3DFX_VOODOO2)) {
  332                 tdfx_info->mrdesc.mr_len = 0x400000;
  333 
  334                 /* The memory descriptor is described as the top 15 bits of the real
  335                         address */
  336                 tdfx_info->mrdesc.mr_base = tdfx_info->addr0 & 0xfffe0000;
  337         }
  338         else if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3) ||
  339                         (pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE)) {
  340                 tdfx_info->mrdesc.mr_len = 0x1000000;
  341                 /* The Voodoo3 and Banshee LFB is the second memory address */
  342                 /* The memory descriptor is described as the top 15 bits of the real
  343                         address */
  344                 tdfx_info->mrdesc.mr_base = tdfx_info->addr1 & 0xfffe0000;
  345         }
  346         else
  347                  return 0;      
  348         /* 
  349     *   The Alliance Pro Motion AT3D was not mentioned in the linux
  350          * driver as far as MTRR support goes, so I just won't put the
  351          * code in here for it. This is where it should go, though. 
  352          */
  353 
  354         /* Firstly, try to set write combining */
  355         tdfx_info->mrdesc.mr_flags = MDF_WRITECOMBINE;
  356         bcopy("tdfx", &tdfx_info->mrdesc.mr_owner, 4);
  357         act = MEMRANGE_SET_UPDATE;
  358         retval = mem_range_attr_set(&tdfx_info->mrdesc, &act);
  359 
  360         if(retval == 0) {
  361 #ifdef DEBUG
  362                 device_printf(dev, "MTRR Set Correctly for tdfx\n");
  363 #endif
  364         } else if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO2) ||
  365                 (pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO1)) {
  366                 /* if, for some reason we can't set the WRCOMB range with the V1/V2, we
  367                  * can still possibly use the UNCACHEABLE region for it instead, and help
  368                  * out in a small way */
  369                 tdfx_info->mrdesc.mr_flags = MDF_UNCACHEABLE;
  370                 /* This length of 1000h was taken from the linux device driver... */
  371                 tdfx_info->mrdesc.mr_len = 0x1000;
  372 
  373                 /*
  374                  * If, for some reason, we can't set the MTRR (N/A?) we may still continue
  375                  */
  376 #ifdef DEBUG
  377                 device_printf(dev, "MTRR Set Type Uncacheable %x\n",
  378                     (u_int32_t)tdfx_info->mrdesc.mr_base);
  379 #endif
  380         }
  381 #ifdef DEBUG
  382         else {
  383                 device_printf(dev, "Couldn't Set MTRR\n");
  384                 return 0;
  385         }
  386 #endif
  387         return 0;
  388 }
  389                 
  390 static int
  391 tdfx_open(struct cdev *dev, int flags, int fmt, struct thread *td)
  392 {
  393         /* 
  394          *      The open cdev method handles open(2) calls to /dev/3dfx[n] 
  395          * We can pretty much allow any opening of the device.
  396          */
  397         struct tdfx_softc *tdfx_info = dev->si_drv1;
  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 = dev->si_drv1;
  415         if(tdfx_info->busy == 0) return EBADF;
  416         tdfx_info->busy = 0;
  417 #ifdef  DEBUG
  418         printf("Closed by #%d\n", td->td_proc->p_pid);
  419 #endif
  420         return 0;
  421 }
  422 
  423 static int
  424 tdfx_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int nprot)
  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);

Cache object: 9eb63080d177af24e7cbe424094f496a


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.