Subversion Repositories f9daq

//****************************************************************************

// Copyright (C) 2000-2006  ARW Elektronik Germany

//

//

// This program is free software; you can redistribute it and/or modify

// it under the terms of the GNU General Public License as published by

// the Free Software Foundation; either version 2 of the License, or

// (at your option) any later version.

//

// This program is distributed in the hope that it will be useful,

// but WITHOUT ANY WARRANTY; without even the implied warranty of

// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

// GNU General Public License for more details.

//

// You should have received a copy of the GNU General Public License

// along with this program; if not, write to the Free Software

// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

//

// This product is not authorized for use as critical component in 

// life support systems without the express written approval of 

// ARW Elektronik Germany.

//  

// Please announce changes and hints to ARW Elektronik

//

// Maintainer(s): Klaus Hitschler (klaus.hitschler@gmx.de)

//

//****************************************************************************

//****************************************************************************

//

// askpci.c - a hardware independent tool to get 

//            information about searched pci-hardware

//

// $Log: askpci.c,v $

// Revision 1.7  2006/06/04 12:20:46  klaus

// release_20060604; Version 3.2; pci_{en|dis}able_device() added

//

// Revision 1.6  2004/08/13 19:23:26  klaus

// conversion to kernel-version 2.6, released version 3.0

//

// Revision 1.5  2002/10/18 21:56:28  klaus

// completed functional features, untested

//

// Revision 1.4  2002/10/18 21:56:28  klaus

// completed functional features, untested

//

// Revision 1.3  2002/10/10 18:57:46  klaus

// source beautyfied

//

//****************************************************************************

/*--- INCLUDES -------------------------------------------------------------*/

#include "common.h"  /* must be the first include */

#include <linux/pci.h>

#include <asm/types.h>

#include "askpci.h"

/*--- DEFINES ---------------------------------------------------------------*/

/*--- FUNCTIONS -------------------------------------------------------------*/

void DeletePCIConfig(DRIVER_OBJ *drv)

{

    PCIConfig *dev = NULL;

    while (!list_empty(&drv->pciList))     // cycle through the list of pci devices and remove them

    {

        dev = (PCIConfig *)drv->pciList.prev; // empty in reverse order

        #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,10)

        if (dev->pciDev)

                      pci_disable_device(dev->pciDev);

        #endif          

        list_del(&dev->list);

        kfree(dev);

    }

}

int GetPCIConfig(DRIVER_OBJ *drv, u16 device_id, u16 vendor_id, u16 subsys_id, u16 subven_id)

{

    int result     = 0;

    PCIConfig *dev = NULL;

    int i          = 0;

    // search pci devices

    PRINTK(KERN_DEBUG "%s : GetPCIConfig(0x%04x, 0x%04x, 0x%04x, 0x%04x)\n", DEVICE_NAME, device_id, vendor_id, subsys_id, subven_id);

#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)

        if (CONFIG_PCI)

#else

        if (pci_present())

#endif

    {

        struct pci_dev *pciDev;

        struct pci_dev *from = NULL;

        do

        {

// https://groups.google.com/forum/?fromgroups=#!topic/fa.linux.kernel/aMXNYIFrOP8

//            pciDev = pci_find_device((unsigned int)vendor_id, (unsigned int)device_id, from);

            pciDev = pci_get_device((unsigned int)vendor_id, (unsigned int)device_id, from);

            if (pciDev != NULL)

            {

                u16 wSubSysID;

                u16 wSubVenID;

                // a PCI device with PCAN_PCI_VENDOR_ID and PCAN_PCI_DEVICE_ID was found

                from = pciDev;

                #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,10)

                if (pci_enable_device(pciDev))

                  continue;  

                #endif

                // get the PCI Subsystem-ID

                result = pci_read_config_word(pciDev, PCI_SUBSYSTEM_ID, &wSubSysID);

                if (result)

                {

                    result = -ENXIO;

                    goto fail;

                }

                // get the PCI Subvendor-ID

                result = pci_read_config_word(pciDev, PCI_SUBSYSTEM_VENDOR_ID, &wSubVenID);

                if (result)

                {

                    result = -ENXIO;

                    goto fail;

                }

                // get next if the subsys and subvendor ids do not match

                if ((wSubVenID != subven_id) || (wSubSysID != subsys_id))

                    continue;

                // create space for PCIConfig descriptor

                if ((dev = (PCIConfig *)kmalloc(sizeof(PCIConfig), GFP_KERNEL)) == NULL)

                {

                    result = -ENOMEM;

                    goto fail;

                }

                // put data into pci device

                dev->pciDev = pciDev;  

                list_add_tail(&dev->list, &drv->pciList);  // add this device to the list of unchecked devices

                dev->index++;

                i++;

            }

        } while (pciDev != NULL);

        result = 0;

    }

    else

    {

        printk(KERN_ERR "%s: No pcibios present!\n", DEVICE_NAME);  

        result = -ENXIO;

    }

    fail:

    if (result)

        DeletePCIConfig(drv);

    PRINTK(KERN_DEBUG "%s : %d devices found (%d).\n", DEVICE_NAME, i, result);

    return result;  

}

/* ------------------------------------------------------------------------- */

/* ------------------------------------------------------------------------- */